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A3SIRACT 



There existed a need for an interactive program chat 
would provide the user assistance in solving applications of 
linear control theory. The Linear Control Program (LINCON) 
and its user's guide satisfy this need. A series of ten 
interactive programs are presented which permit the user to 
carry out analysis, design and simulation of a broad class 
of linear control problems. 

LINCON consists of two groups: matrix manipulation, 

transfer function and time response programs; and modern 
controls programs. Examples for each ar® worked within each 
terminal session section. 
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I 



INTRODUCTION 



The purpose of this thesis was to update an existing 
program which provides assistance in solving computational 
problems associated with the study and application of linear 
control theory. The Linear Controls Program (LINCON) was 
first developed by Meisa [ 1] ar.d adapted for batch use at 
NPS by Desjardins [2]. Although the original intent of 
this thesis was simply to take Desjardins’ adapted version 



of Meisa' s 


LINCON 


and further adapt it 


by making it 


interactive , 


LINCON 


soon began to grow as 


other routines 



were incorporated, as will be noted, until its present form 

* 

was achieved. 

LINCON, as such, is a hig.i level applications software 
system made up of a large number of program tools for 
interactive analysis, design ana simulation of a broad class 
of linear control problems. With LINCON, users can 
concentrate on their specialized applications rather than 
system design and routine program development, thereby 
saving valuable time. 

It is assumed that the reader is familiar with the basic 
concepts of linear control theory as may be obtained from 
any one of a number of available textbooks (see the 
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LINCON subprograms are 



bibliography). As such, tha 
presented in a user-oc iented fashion. First, their purpose 
and some general rules that may apply are given; then the 
input requirements are presented and the expected outputs 
are described. Examples for each are worked cut including a 
copy of the terminal session and the final results. 
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II 



SYSTEM OVERVIEW 



During LINCON's latest development, underlying 
guidelines called for concepts which accounted for the needs 
of the computer system, the programmer, and the user. 

The guidelines followed luring this latest development 
stage were: 

(1) Operation of the system should be in an on-line 

interactive mode such that data can be easily input 
to (or output from) the system and readily accessed 
for verification, examination, and processing. 

(2) Program development should be in a high-level 

language in order to facilitate software 

implementation and promote machine independence. 

(3) The software should be modular in structure so that 

programs can be modified or inserted without 

affecting existing programs. 

(4) Programs should be invoked by means of logical 

procedures or commands which minimize interaction 
time and which are user-oriented so that people can 
operate the system without first becoming computer 
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exp arts . 



A. INTERACTIVE OPERATION 



The applications of LINCON are focused on interactive 
processing. Experience has shown that interactive on-line 
communication has many advantages in a research environment 
because it offers the opportunity to make observations ana 
select alternate courses of action in a more flexible manner 
than with batch processing [ 3]. LINCON is organized around 
a collection of inter-related command programs, each of 
which performs a specified function and can be executed by 
means of a simple keyboard initiation sequence. 

B. HIGH LEVEL LANGUAGE 

An important feature in the design of LINCON is than it 

was implemented in a high level language. Program 

development in assemoly language is more time consuming and 
results in system dependent software. 

LINCON is programmed in ANSI standard FORTRAN and 
follows the conversions of FORTRAN IV. FORTRAN has been 

found to be a useful Language for several reasons: 

(1) Since some form of FORTRAN is available on most 
computers, LINCON is highly portable from one 

computer to another. A FORTRAN based sysrem is 

helpful for importing programs as well as exporting 
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them. Of coarse, FORTRAN compilers don't all follow 
the same standards so there can still he 

difficulties. 

(2) FORTRAN is a simple enough language that relatively 
complex programs can be implemented in a short 
period of time. Most scientific and research 
personnel k now FORTRAN sufficiently well to write 
their own programs if necessary. 

(3) Algorithms can be tested and implemented in FORTRAN 

and later converted to assembly language versions if 
more speed and efficiency are necessary. This 

procedure has the further benefit of aiding 
portability such that even if parts have been 
converted to assembler, equivalent FORTRAN versions 
are available. 



C. MODULAR SOFTWARE 



Overall system flexibilty 
modularity. LINCON is actually 
independent command programs, 
or. its own with che ability t 
possibly supplied by some prev 
seme form of ouxput, possibly 
command. 



is achieved by means of 
made up of a large number of 
Each command program stands 
o rake some form of input, 
ious command, and generate 
to be used by a follow-up 
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D. USER-OR IENTED OPERATION 

An important aspect in this modification of LINCON was 
to make the commands user-orie nned so that operating the 
system does not require an engineering or computer 

background. This was achieved with a standard terminal 

keyboard by using phonetic characters which relate to the 
function which the command is to perform. A good 

combination of brevity and clarity is built into LINCON to 
avoid having to push extra buttons on the keyboard- while at 
the same time preventing ambiguity. 

E. INPOT RESTRICTIONS AND LIMITATIONS 

Although the input requirements are fully described in 
the presentation of each program, there are several input 
format similarities used by all of them. For ease of use, 
ana, more honestly, for ease of programming, most of the 
data input is grouped in the same arrangement. 

The first input of every program is used to identify the 
problem for reference and for output data. A maximum of 
twenty alpha-numeric characters can be used. This 
restriction was not a system limitation bun a programmer 
decision. 
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The next input common to all programs is the dimension 
of the plant matrix or A matrix. The format is II which 
would normally restrict the user to a maximum matrix size of 
9x9, however, due to, again, a programmer decision, a 
dimension size not to exceed 3 is requested. The reasoning 
behind this was due, in part, to the printer. The NFS 
printer is capable of printing 133 characters on a line. 
Since the output format to the printer is 8E16.6 this 
naturally limits one to 8 numbers per line. Six places are 
normally considered necessary for good accuracy. A solution 
that would have lead to an unlimited matrix size would have 
been to incorporate a '‘wrap around" routine within the 
program. After attempting this it was decided the results 
were just too difficult to read. 

Matrices are entered one element at a time beginning 
with element 1,1 and continuing across the row. The next row 



is then 


entered, and the proc 


ess continues until 


all 


elements 


ha ve 


been entered. After 


the matrix is entered. 


the 


complete 


m a tr i 


x is automatically 


brought oo the screen 


for 



review and possible correction. If a change to the matrix is 
desired the user simply enters the row number and column 
number without a separating comma. For example, 35 would 
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indicate the element in row 3 and column 5. After being 
prompted the change is entered. A review of the matrix is 
again screened. The user is again prompted for any possible 
changes. This procedure continues until all changes have 
been made. 

Any special requirements or limitations will be brought 
to the user’s attention within each program presentation. 
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III. MATRIX MAN I? J LATION, TRANSFER FUNCTION AND TIME 

RESPONSE PROGRAMS 



A. INTRODUCTION 

In this chaptsr four programs are discussed which may be 
used for the analysis and design of linear control systems 
represented in state variable form as 



x (t) = Ax ( t ) + bu ft) (3-. A- 1) 

u (t) = K[r(t) - k T x ( 1 1 ] (3. A-2) 

Y (t) = c T x(t) (3. A-3) 



The first, BASMAT, is tie Basic Matrix manipulation 
program which is ised for computing the determinant, 

inverse, characteristic polynomial, and eigenvalues for a 
square matrix A. Ia addition, BASMAT will calculate the 
state transition matrix and the PHI (s) matrix. The second 
program, PRFEXP, calculates the partial fraction expansion 
of a polynomial. The third program, ROOTS, calculates the 
roots of a polynomial. The fourth program is used for 

determining the time response of linear control systems. 
RTPESP will determine the rational time response of a system 
in closed-form provided that the input function r(t) has a 
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rational 



time response and that there be no repeated 



eigenvalues in the combination of the system and input, 
should be noted here, and will be again in the ac 
discussion cf the program, that by setting r (t) and K e 
to zero, unforced and open-loop systems may be stud 
respectf ull y. 



It 
tual 
gual 
iea , 
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B. BASIC MATRIX PROGRAM (BASMAT) 

Given the plant matrix A, BASMAT can compute the 

following: 

(1) the determinant of A, det A 

(2) the inverse of A , A -1 

(3) the characteristic polynomial, det(sI-A) 

(4) the eigenvalues of the characteristic polynomial, X 

(5) the state transition matrix, §(t) = exp (At) 

(6) the PHI (s) matrix, f (s) = (sI-A) -» 

1. Terminal Session Example 

This section contains a terminal session for a 
specific problem. Commands entered by the user are in 

lower case. All of 3ASMAT's capabilities will be utilized 
beginning with following plant matrix: 



A 



1 . 0 

0.0 

0.0 



0 . 0 

- 2.0 

-0.5 



0.0 

1.0 

1.0 



line on 

EXECUTION 3EGINS... 

LINCON CONSISTS OF THE FOLLOWING SUBPROGRAMS: 

3A3IC MATRIX MANIPULATION - <3ASMAT> 

RATIONAL TIME RESPONSE - <RTRESP> 

STATE VARIABLE FEEDBACK - <3TVAR> 

CONTROLLABILITY AND OBSERVABILITY - <OBSCON> 
LUENBERGER OBSERVER - <LUEN> 

OPTIMAL CONTROL/KALMAN FILTERS - <RICATI> 

DISCRETE TIME KALMAN FILTER - <KALM AN> 

OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <?RFEX?> 

ROOTS OF A POLYNOMIAL - <R0DTS> 

TO USE ONE OF THE SUBPROGRAMS ENTER THE NAME 3ETVEEN THE 
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SYMBOLS < >. 
basmat 



BASMAT PROVIDES MATRIX MANIPULATION TO SOLVE 
FOR DETERMINANTS, INVERSES, STATE TRANSITION AND 



PHI 



MATRICES, EIGENVALUES, AND CHARACTERISTIC 



POLYNOMIALS. 

FIRST ENTER THE PROBLEM IDENTIFICATION 
(♦NOT TO EXCEED 20 CHARACTERS*) 
thesis exatnple 

NOW ENTER THE DIMENSION OF THE A MATRIX (UP TO 8) 



1.0 



0.0 



0.0 



0.0 



THE ELEMENT A (1 , 1 » = 



THE ELEMENT A (1 ,2) = 



THE ELEMENT A(1 ,3) = 



THE ELEMENT A (2,1) = 



THE ELEMENT A(2,2) = 

- 2.0 



1.0 



0.0 



THE ELEMENT A(2,3) = 
THE ELEMENT A (3 , 1 ) = 



THE ELEMENT A (3 , 2 ) = 
-0.5 



1.0 



THE ELEMENT A (3, 3) = 



THE A MATRIX 

1 . COE + 00 0. 0 0.0 

0.0 -2.00E+00 1.00E+00 

0.0 -5.00E-01 1.002+00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 
n 

DO YOU WANT TO CALCULATE THE DETERMINANT? 

y 

THE DETERMINANT OF THE MATRIX 
-1 . 50E + 00 

ARE YOU SATISFIED WITH THE RESULTS? 

y 

DO YOU WANT THE DETERMINANT PRINTED? 

y 

DO YOU WANT TO CALCULATE THE INVERSE? 

y 
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THE INVERSE OF THE MATRIX 

1. OOE + OO 0.3 0.0 

0.0 -6.57E-01 5.S7E-01 

0. 0 -3.33E-31 1.33E+00 

ARE YOU SATISFIED WITH THE RESULTS? 

y 

DO YOU WANT THE INVERSE PRINTED? 

y 

• DO YOU WANT TO CALCULATE THE PHI (S) MATRIX? 

y 

*********************************************************** 

THE MATRIX COEFFICIENTS OF THE NUMERATOR OF THE 
PHI (S ) MATRIX 

THE MATRIX COEFFICIENT OF 5**2 

1 . OOE + OO 0. 0 0.0 

0.0 1. OOE + OO 0.0 

0. 0 0.0 1. OOE+OO 

THE MATRIX COEFFICIENT OF 3**1 

1. OOE + OO 0. 0 0.0 

0.0 -2. OOE+OO 1. OOE+OO 

0.0 -5.00E-01 1. OOE + OO 

THE MATRIX COEFFICIENT OF 5**0 

-1.50E + 00 0. 0 0.0 

0.0 1.0 OE + OO -1 . OOE + OO 

0.0 5.00E-01 -2. OOE+OO 

ARE YOU SATISFIED WITH THE RESULTS? 

A NO RESPONSE WILL GIVE YDU THE OPTION TO MAKS 
CHANGES TO THE A MATRIX. 

y 

DO YOU WANT A PRINTOUT OF THE RESULTS? 

y 

DO YOU WANT TO CALCULATE THE CHARACTERISTIC POLYNOMIAL? 

y 

THE CH ARACTERISTI C POLYNDMIAL-IN ASCENDING POWERS OF S 
1.50E + 00 -2. 5 OE + OO 0.0 1. OOE + OO 

ARE YOU SATISFIED WITH THE RESULTS? 

y 



DO YOU WANT THE C 3 ARAC TERIS T IC POLYNOMIAL PRINTED? 

y 

DO YOU WANT TO CALCULATE THE EIGENVALUES? 
******************************************** ************ *** 
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THE EIGENVALUES OF THE A MATRIX 
REAL PART IMA3 . PART 
8.23E-01 0.3 

-1.82E + 00 0.3 

1 . 00E + 00 0. 3 

ARE YOU SATISFIED WITH THE RESULTS? 

Y 

DO YOU WANT THE EIGENVALUES PRINTED? 

Y 

DO YOU WANT TO CALCULATE THE STATE TRANSITION MATRIX? 

y 

a************************* ******* ************************** 



y 

y 



THE ELEMENTS OF T 
THE MATRIX COEFFI 



0. 0 
0 . 0 
0 . 0 



0 . 3 
-6.5 
-1.3 



HE STATS TRANSITION MATRIX 
CIENT OF E X P ( 8 . 23E-3 1 ) T 

3 3 

9E-32 3^783-01 

9E-01 1.37E+00 



THE MATRIX COEFFICIENT OF EXP( -1.32E+00)T 



0 . 0 
0 . 0 
0 . 0 



0.3 3.3 

1.07E+00 -3.73S-01 
1.39E-01 -6.59E-02 



THE MATRIX COEFFICIENT OF 3XP( 1.00E+30)! 



1 . Q0E + 00 0. 3 

0.0 - 2.2 

0.0 -5.3 

ARE YOU SATISFIED 
A NO RESPONSE WILL 
CHANGES TO THE A M 



6E-06 2.36E-06 

6E-07 1.37E-06 

WITH THE RESULTS? 

GIVE THE OPTION TO MAKE 
ATRIX. 



DO YOU RANT A PRINTOUT OF THE RESULTS? 

THIS CONCLUDES THE BASIC MATRIX MANIPULATION PROGRAM 
(BASMAT) . 

ANALYSIS IS COMPLETE. DO YOU WANT TO RUN LINCON AGAIN? 



LINCON IS NOW TERM 
The computer 



INAT ED. 

results ere shown in Appendix A. 



Interpretation of the determinant, 



inverse and eigenvalues 



are straightforward. The PHI (si matrix is a combination of 
the numerator coefficients and characteristic polynomial. 
The results can be interpreted as 
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1 




1 

s2-2.5s* 1 .5 



r 32f S -1.5 0.0 

0.0 s2-2.0s^1 

0.0 - 0. 5s + 0. 5 



0.0 

s-1 

s 2 +s -2 



and, simlariiy, the fifth term of the state transition 
matrix is 

$(t) = -0. 067exp (0 . 92t) + 1 . 07 exp (- 1 . 82t) - 2 . 26x 1 0~ 6 exp (t) 
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C. PARTIAL FRACTION EXPANSION PROGRAM (PRFEXP) 



PRFEXP 
a rational 



can calculate a partial fraction expansion given 
ratio of two polynomials in the form 



N (3) 

G{3) = K (3.C-1) 

D (3) 

* tier® K = the input function gain, 
a constant 

N (s» = n, *• s + n 3 s 2 + ... ♦ s'* 
and D(s) » d, + d z s +• d 3 s 2 + ... s p 



The numerator and denominator coefficients muse be arranged 
so that the coefficients of s and s are each unity with 
p > g > 0. The outputs of the program are 

(1) the numerator gain 

(2) the numerator polynomial and its roots; roots are 
considered equal if their real and imaginary parts 
do not differ by more than 0.005. 

(3) the denominator polynomial and its roots; multiple 
roots are listed once, along with its multiplicity 

(4) the numerator coefficients (residue matrix) are 
listed in the same order as the denominator roots; 
the first coefficient in any row of the matrix is 
the first-order term coefficient. 
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1. Terminal Session E xa mple 

The partial fraction expansion of the following 
rational polynomial is to be performed: 



G(S) = 



14 (32+2) (S+1) 
2s 4 + 5 s 3 +2 s + 5 



Putting the polynomial in a usaDle form yields 



G (S) = 



7 (s 3 + s 2 +2s + 2) 
s 4 + 3s 3+s«- 2. 5 



lir.con 

EXECUTION BEGINS... 

LINCON CONSISTS OF TUB FOLLOWING SUBPROGRAMS: 

BASIC MATRIX MANIPULATION - <3ASMAT> 

RATIONAL TIME RESPONSE - <RIRESP> 

STATE VARIABLE FEEDBACK - <3IVAR> 

CONTROLLABILITY AND OBSERVABILITY - <OBSCON> 
LUENBERGER OBSERVER - <LUEN> 

OPTIMAL CONTROL/KALMAN FILTERS - <RICATI> 

DISCRETE TIME KALMAN FILTER - <KALMAN> 

OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <PRFEXP> 

ROOTS OF A POLYNOMIAL - <RODIS> 

TO USE ONE OF THE SUBPROGRAMS ENTER THE NAME BETWEEN THE 
SYMBOLS < >. 
prf exp 

PREEXP IS USED TO DETERMINE THE PARTIAL 

FRACTION EXPANSION OF THE RATIO OF TWO POLYNOMIALS. 

FIRST ENTER THE PROBLEM IDENTIFICATION 
(* NOT TO EXCEED 20 CHARACTERS*) . 
thesis exa irpie 

ENTER THE INPUT FUNCTION GAIN — K. 

7. 

THE INPUT FUNCTION GAIN 
7. 00E + 00 

DO YOU WANT TO CHANGE THE VALUE OF THE GAIN? 
n 

ENTER THE NUMERATOR BY POLYNOMIAL COEFFICIENT OR 
FACTORED ROOT FORM. FIRST ENTER EITHER THE LETTER P 
FOR POLYNOMIAL COEFFICIENT FORM OR THE LETTER F FOR 
FACTORED ROOT FORM. 
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2 . 



2 . 



1 . 



1 . 



ENTER 'THE NUMERATOR POLYNOMIAL ORDER. 

THE POLYNOMIAL COEFFICIENTS MUST BE ENTERED IN ASCENDING 
ORDER OF S. 

♦♦WARNING— THE HIGHEST ORDER COEFFICIENT MUST BE UNITY.* 
DO YOU NEED TO CHANGE THE INPUT FUNCTION GAIN TO SATISFY 
THIS REQUIREMENT? 

ENTER THE POLYNOMIAL COEFFICIENTS IN ASCENDING 
ORDER OF S. 

CO EFF ( 1 ) = 

COEFF ( 2) = 

COEFF ( 3 ) = 

COEFF ( 4 ) = 



NUMERATOR COEFFICIENTS - IN ASCENDING POWERS OF S 
2 . 00E+00 2.00E+00 1.00E+00 1.00E+00 

NUMERATOR ROOTS ARE 

REAL PART IMA3 . PART 
,0.0 -1.41E+00 

0.0 1.41E+00 

- 1 . COE + 00 0.0 

ENTER THE DENOMINATOR 3Y POLYNOMIAL COEFFICIENT OR 
FACTORED ROOT FORM. FIRST ENTER EITHER THE LETTER P FOR 
POLYNOMIAL COEFFICIENT FORM OR THE LETTER F FOR FACTORED 
ROOT FORM. 



P 

4 



2. 5 



1 . 



ENTER THE DENOMINATOR POLYNOMIAL ORDER. 

THE POLYNOMIAL COEFFICIENTS MUST 3E ENTERED IN ASCENDING 
ORDER OF S. 

♦♦WARNING — THE HIGHEST ORDER COEFFICIENT MUST BE UNITY.* 
DO YOU NEED TO CHANGE THE INPUT FUNCTION GAIN TO SATISFY 
THIS REQUIREMENT? 

ENTER THE POLYNOMIAL COEFFICIENTS IN ASCENDING 
ORDER OF S. 

COEFF ( 1 )= 

COEFF (2 )= 

COEFF (3 )= 



3. 



1 . 



COEFF (4 ) = 



COEFF (5 )= 
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DENOMINATOR COEFFICIENTS - IN ASCENDING POWERS OF S 



RESIDUE MATRIX - REAL PART 
5. 81E + 00 

3. 17E-01 

4. 36E-01 
4. 36E-01 

RESIDUE MATRIX - IMA3. PART 
-2. C5E-07 
0 . 0 

2 . C6E+00 
-2. C6E+00 

THIS CONCLUDES THE PARTIAL FRACTION EXPANSION PROGRAM 
(PRFEXP) . 

DO YOU WANT TO RUN THE PROGRAM AGAIN? 



ANALYSIS IS COMPLETE. DO YOU WANT TO RUN LINCON AGAIN? 



LINCON IS NOW TERMINATED. 

The results are shown in Appendix B. Interpretation of 
these results are: 



2.50E+00 1.00E+00 3.0 



3.00E+00 1.00E+00 



DENOMINATOR ROOTS ARE 



REAL PART IMAG. PART MULTIPLICITY 



-3. 0 19E + 00 0.3 1 

-9. 1 28E-01 3.0 1 

4. 658E-01-8.308E-3 1 1 

4. 658E-01 8.308E-31 1 



n 



n 



G(s) 



s- 5 .8 1 + jO 



s-0.32 



3-0.44-j2.06 s -0 . 4 4+ j2 .06 



s + 3.02 



3+9.13 
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D. POLYNOMIAL ROOTS PROGRAM (ROOTS) 



ROOTS can calculate the roots of a polynomial of degree 
less than or equal to eight. Siren a polynomial in the form 

P(s)=p,+p 1 sfp 3 s 2 +-...+s (3.D-1) 

the coefficient of s* must be unity. The program output 
lists the polynomial coefficients for reference and the real 
and imaginary roots. 

1. Terminal Session Example 

The following polynomial is to be factored: 

P (s) = -5s 3 * 15s 2 - 25.5s + 4 



Putting the polynomial in the required form yields 



?(s) = s 3 - 3s 2 + 5.1s - 0.3 



lincon 

EXECUTION BEGINS... 

LINCON CONSISTS OF THE FOLLOWING SUBPROGRAMS: 

BASIC MATRIX MANIPULATION - <B AS M AT> 

RATIONAL TIME RESPONSE - <RTRESP> 

STATE VARIABLE FEEDBACK - <5TVAF.> 

CONTROLLABILITY AND OBSERVABILITY - <OBSCON> 
LUENBERGER OBSERVER - <L T JEN> 

OPTIMAL CONTROL/KALMAN FILTERS - <RICATI> 

DISCRETE TIME KALMAN FILTER - <KALMAN> 

OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <?RFEXP> 

ROOIS OF A POLYNOMIAL - <ROOTS> 

TO USE ONE OF THE SUBPROGRAMS ENTER THE NAME BETWEEN THE 

SYMBOLS < >. 

roots 
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ROOTS IS USED TO FIND THE ROOTS OF A POLYNOMIAL OF 
DEGREE LESS THAN DR EQ DAL TD EIGHT. 

FIRST ENTER THE PROBLEM IDENTIFICATION 
(NOT TO EXCEED 2D CHARACTERS) . 
thesis exa mple 

ENTER THE ORDER DF THE SYSTEM (DP TO 8). 



ROOTS OF A POLYNOMIAL 

ENTER THE POLYNOMIAL COEFFICIENTS IN ASCENDING 
ORDER OF S. 

♦♦WARNING — THE HIGHEST ORDER COEFFICIENT MUST BE UNITY.* 
COEFF ( 1 )= 



5. 1 



COEFF (2 ) = 



3. 



COEFF (3 ) = 



COEFF (4 ) = 



POLYNOMIAL COEFFICIENTS - IN ASCENDING POWERS OF S 
8.00E-01 5.10E+00 3.DDE+00 1.00E+00 

THE ROOTS ARE REAL PART IMAG. PART 

- 1. 41 Ei- 00 1.62E+0D 

- 1 . 41 E*00 -1 .62E + 00 

-1.74E-01 0.0 

THIS CONCLUDES THE POLYNOMIAL ROOTS PROGRAM. 

DO YOU WANT TO RUN THE PROGRAM AGAIN? 
n 

ANALYSIS IS COMPLETE. DO YO'J WANT TO RUN LINCON AGAIN? 

R 

LINCON IS NOW TERMINATED. 

The results shown 1.1 Appendix C are easily 



interpreted . 
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E. RATIONAL TIME RESPONSE PROGRAM (RTRESP) 

The time response in closed form cf a linear control 
system described by Egs. (3.A-1), (3.A-2) and (3.A-3) is 

calculated by this program. The user must define the 
initial conditions x(0) and trie rational Laplace transform 
of the scalar forcing function r(t). The theoretical 
concepts involved in the development of the computer codes 
are described by Melsa [ 1 ]. 

1. Inp ut Restrictions And Limitations 

Enter the following in F format (floating point) : 

1) the elements of the plant matrix A 

2) the control vector b 

3) the output vector c 

4) the feed backback coefficent vector k 

5) the controller gain :< 



and 



6) the initial conditions vector x(0). 
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The rational Laplace transform of the input function 
must be in the fora 

y n ( s i 

<< [r (t) ] = R(S) = G (3. E-1) 

D (3> 

where 3 = the input function gain, 

a constant 

N (s) = n» + n ; s «■ n_jS 2 + ... + s^ 
and D(s) = d, + d t s *■ d 3 s z + ... + s f 

The numerator and denominator coefficients must be arranged 
so that the coefficients of s'* and s r are each unity with 
p > g > 0. Due to programming limitations it is necessary 
that the order of the system plus the dimension of D (s) be 
less than or egual to ten. 

Upon entering the input function gain, the user next 
has the option to enter the numerator and denominator in 
either polynomial coefficient form or factored root form. 
With the factored root form enter the real part of the root 
as negative if it lies in the left half plane and just the 
magnitude of the imaginary part. 

2. iS.ij24s.sl Session Example 

This section contains a terminal session for a 
specific example. Commands entered by the user are in lower 
case. The RTRESP program will determine the time response 
form of the closed-loop system 
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X(t) 



r 1.0 

= 0.0 
0.0 

I. 



0.0 0 . 0 0.0 

•2.0 1.0 x(ti + 0. 0 u (t| 

•0.5 1.0 “ 1.0 



u(t) = 3. 2 (r (t) - [1.0 1.0 0.0] x(t|| 



2(t) = [1.0 0.4 1.0] x ( t ) 



if the Laplace transform of the input function is 



R (s ) = 0.5 



s + 1.0 

’s2*""2To 



and the initial conditions are zero. 

Note here that the open-loop rational time response 
may be calculated by setting the feedback coefficient vector 
k equal to a zero vector. Also, if only an initial 
condition response is desired, the input function gain G is 
set to zero . 



iinccn 

EXECUTION BEGINS... 

LINCON CONSISTS OF IBS FOLLOWING SUBPROGRAMS : 

BASIC MATRIX MANX? ULAr ION - <3ASMAT> 

RATIONAL TIME RESPONSE - <RTRESP> 

STATE VARIABLE FEEDBACK - <5TVAR> 

CONTROLLABILITY AND 03S ERV A3 I LIT Y - <OBSCON> 

LUEN BERGER OBSERVER - <LUEN> 

OPTIMAL CONTROL/KALMAN FILTERS - <RICATI> 

DISCRETE TIMS KALMAN FILTER - <KALM AN> 

OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <PRFEXP> 

ROOTS OF A POLYNOMIAL - <RO0TS> 

TO USE ONE OF THE SUBPROGRAMS ENTER THE NAME BETWEEN THE 

SYMBOLS < >. 

rtresp 
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RTRESP DETERMINES THE TIME RESPONSE OF A LINEAR 
FESD3AC K CONTROL SYSTEM. THIS PROGRAM HILL GIVE A 
CLOSED-FORM EXPRESSION FOR THE TIME RESPONSE. 

FIRST ENTER THE PROBLEM IDENTIFICATION 
(NOT TO EXCEED 20 CHARACTERS), 
thesis example 

ENTER THE ORDER OF THE SYSTEM (DP TO 8). 

ENTER THE ELEMENTS OF THE PLANT MATRIX-- A. 

A(1, D = 



1.0 



0.0 



0.0 



0.0 



A ( 1 , 2) = 



A(1,3) = 
A (2, 1) = 



o £< 2 ' 2) = 
- 2.0 



1.0 



0.0 



A (2,3) = 
A ( 3, 1) = 



n A ( 3, 2) = 

-0.5 



1.0 



A (3, 3) = 



0.0 



0.0 



1.0 



THE A MA I R I X (PLANT MATRIX) 

1. 00E + 0C 0. 0 0.0 

0.0 -2.00E+00 1.00E+00 

0. 0 -5.00E-01 1.00E+00 

DO YOU WANT TO CHANGE ANY ELEMENT(S) OF THE MATRIX? 

ENTER THE ELEMENTS OF THE CONTROL VECTOR — 3. 

B (1) = 

3 (2) = 

B (3) = 

THE B MATRIX (CONTROL VECTOR) 

0 . 0 
0 . 0 

1 . 00E + 00 



DO YOU WANT TO CHANGE ANY ELEMENT (S) OF THE MATRIX? 
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1.0 



ENTER THE ELEMENTS 
C ( 1) = 



OF THE OUTPUT VECTOR — C. 



0.4 



C(2) = 



1.0 



C ( 3) = 



THE C MATRIX (OUTPUT VECTOR) 

1 . OOE + OO 
4. COE - 0 1 
1 . 00E + 00 

DO YOU WANT TO CHANGE ANY ELEMENT (S) OF THE MATRIX? 
n 

ENTER THE ELEMENTS OF THE FEEDBACK COEFFICIENT VECTOR 
FDBG. 

„ FD BG (1 ) = 

1 . 0 

„ FDBG (2) = 

1 . 0 

FDBG (3) = 

0.0 

THE FEEDBACK COEFFICIENT VECTOR 

1 . oos + oo 

1 . C0E + 00 
0. 0 

DO YOU WANT TO CHANGE ANY ELEMENT (S) OF THE VECTOR? 
n 

ENTER THE CONTROLLER SAIN— K. 

3.2 

THE CONTROLLER SAIN 
3. 20E+00 

DO YOU WANT TO CHANGE THE VALUE OF THE GAIN? 
n 

ENTER THE ELEMENTS OF THE INITIAL CONDITIONS VECTOR - 
X(0) . 

XO (1) = 

0.0 

XO (2) = 

0.0 



XO (3) = 

G.O 

INITIAL CONDITIONS VECTOR-X(O) 

0 . 0 
0 . 0 
0 . 0 
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DO YOU WANT TO CHANGE ANY ELEMENT (S) OF THE VECTOR? 

n 



ENTER THE GAIN FOR THE RATIONAL LAPLACE 
TRANSFORM OF THE INPUT FUNCTION. 

0.5 

THE INPUT FUNCTION GAIN = 

5. 00E-01 

DO YOU WANT TO CHANGE THE VALUE OF THE GAIN? 

n 



ENTER THE NUMERATOR BIT POLYNOMIAL 
COEFFICIENT OR FACTORED ROOT FORM. 

FIRST ENTER EITHER THE LETTER P FOR 
POLYNOMIAL COEFFICIENT FORM OR THE LETTER F FOR 
FACTORED ROOT FORM. 



ENTER THE NUMERATOR POLYNOMIAL ORDER. 

1 



ENTER THE REAL PART OF THE ROOT. 

- 1.0 

ENTER THE MAGNITUDE OF THE IMAGINARY ROOT. 

0.0 

NUMERATOR POLYNOMIAL OF R (S) - ASCENDING POWERS OF S 

1. OOE + OO I.OOE + OO 

NUMERATOR ROOTS ARE 
REAL PART IMA3. PART 
-1 . 00E + 00 0. 0 

ENTER THE DENOMINATOR BY POLYNOMIAL 
COEFFICIENT OR FACTORED ROOT FORM. 

FIRST ENTER EITHER THE LETTER P FOR 
POLYNOMIAL COEFFICIENT FORM OR THE LETTER F FOR 
FACTORED ROOT FORM . 



ENTER THE DENOMINATOR POLYNOMIAL ORDER. 

2 

THE POLYNOMIAL COEFFICIENTS MUST BE 
ENTERED IN ASCENDING ORDER OF S. 

WARNING— THE HIGHEST ORDER COEFFICIENT MUST BE UNITY. 

DO YOU NEED TO CHANGE THE INPUT 

FUNCTION GAIN TO SATISFY THIS REQUIREMENT? 



ENTER THE POLYNOMIAL COEFFICIENTS IN 
ASCENDING ORDER OF S. 

„ C0(1) = 

— 2.0 

CO (2) = 

0.0 



1.0 



CO (3) = 
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DENOMINATOR POLYNOMIAL OF R(S) - ASCENDING POWERS OF S 
-2.00E + 00 0.0 1.00E+00 



DENOMINATOR ROOTS ARE 
REAL PART ISAS. PART 
1.41E + 00 0.0 

-1.41E + 00 0.0 

**** ****************** ********************************** *** 



THE TIME RESPONSE OF THE S 



THE 


VECTOR 


COEFFI Cl ENT 


OF 




o 

• 

o 


-3. 7 0E-01 


-9 


THE 


VECTOR 


COEFFI Cl ENT 


OF 




o 

t 

o 


-3.47E-01 


-7 


THE 


VECTOR 


COEFFICIENT 


OF 




o 

• 

o 


0.0 


2 


THE 


VECTOR 


COEFFI CIENT 


OF 




o 

• 

o 


2. 57E-0 1 


9 


THE 


VECTOR 


COEFFI CIENT 


OF 




o 

• 

o 


1. 03E-01 


5 



TATE X (T) 

EXP (-5.0E-01) T*COS (1. 2E + 0 0) T 
72E-01 

EXP (-5.0E-01) T*SIN (1.2E + 00) T 
50E-02 

EX P ( 1 .00E+00) T 

58E-06 

EXP ( 1 . 4 1E+00) T 

1 2E-01 

EX? ( -1 .41E+00) T 
OOE-02 



*********************************************************** 



THE TIME RESPONSE OF THE OUTPUT Y (T) 

THE COEFFICIENT OF EX ? ( -5 . 00 E-0 1 ) T*C0S ( 
-1 . 12E + 00 

THE COEFFICIENT OF EXP( -5.00 E-0 1 ) T*SI N ( 
-2. 14E-01 



THE COEFFICIENT OF EXP ( 1.00E + 00)T 

2. 68E-06 

THE COEFFICIENT OF SXP( 1.41E+00)T 
1 . 02E + 00 

THE COEFFICIENT OF EXP( -1.41E+00)T 
1 . 01 E-0 1 



1 . 20E+00) T 
1. 20E+00) T 



*********** *********** **** ****************************** *** 
THIS CONCLUDES THE RATIONAL TIME RESPONSE PROGRAM 
(RTRES?) 

ANALYSIS IS COMPLETE. DO YOU WANT TO RUN LINCON AGAIN? 



LINCON IS NOW TERMINATED. 
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The computer results shown in Appendix D are 
interpreted as: 



x, (t) 

Xi (t) 



X i (t) 
Y(t) 



0 . 0 



-0 . 37exp (- 0.5t)cosn .2t)-0.35exp(-0.5t)sin(1 .2t) 
+ 0. 67exp(1 . 4 It ) +0. bexp (-1 .41t) 

-0.97exp(-0.5t)CDS(1.2i)-0.08exp(-0.5t)sin(1.2t) 
+ 2. 7x10~’exp(t) +0.91 exp (1 .41t) 0 . 06exp (-1. 41 1) 



-1 . 12exp(-0.5t)cos(1.2-)-0.21exp(-0.5t)sinM .2t) 
+ 2. 7x1D-&exp (t) +1.02 exp (1.4 It) *0. 1exp(-1.4tt) 
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IV. MODERN CONTROL PROGRAMS 

A. INTRODUCTION 

In this chapter six programs are presented and discussed 
which may be used for the analysis and design of control 
systems. 

The first, OB5CON, is used to find the observability 
index and controllability of a system. The next two programs 
are used to design Kalman filters. RICATI and KALMAN can 
find the feedback and control gains necessary to optimize a 
function for either continuous or discrete systems, 

respectively. The last three programs may be used to design 
optimal linear controL systems. S T VAR is particularly useful 
in the design of linear state variable feedback control 
systems. It may be used to calculate both open- and 
closed-loop transfer £ unctions and also has the ability to 
desiqn a closed-loop system from desired transfer function 
specifications. LUEN is used to design a combined, 
reduced-order, observer-controller to achieve a desired 
closed-loop transfer function from a system where some of 
the states are inaccesible. OPTCON will minimize a given 
cost function producing a scalar control. 
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B. OBSERV A BILTIY INDEX AND CONTROLLABILITY PROGRAM (OB5CON) 
This program is used to determine the observability 
index and controllability of the linear system 

X(t) = AX (t) + 3 U (t) (4. 3-1) 

Z(t) = Cx(t) (4. B-2) 



where 



x = state vector (n- dimens ional vector) 



u = control vector ( i-dimsnsional vector) 



y = output vector (m-dimensional vector) 



A = n x n matrix 



3 = n x 1 matrix 



C = m x n matrix 



The observability index 
.nteger such that the matrix 



defined as the minimum 



[C,A C , (A )«*- ic] 



has rank n. The above system is said to be controllable at 
a given initial time if it is possible, by using an 
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unconstrained control vector. 



to force the system from an 
other state in a finite time 



initial state of x(0) to some 
interval [ 4], 

If the user desires just the observability index to be 
calculated, enter the B matrix as a zero matrix. Likewise, 
if just the controllability of the system is desired, enter 
the C matrix as a zero matrix. The unobservable or 
uncontrollable system response is then of course ignored. 

1. IHEUt Re strict ions 

Other than the limitations to the problem 
identification, (20 characters) and system size (8x8) there 
are no restrictions to OBSCON. A reminder here may be> 
helpful, however. Remember to enter your elements of the 
matrices in F format. 



2. Te r minal Session Example 

This section contains a session for a specific 
problem. Commands entered by the user are in lower case. 
The following system is to be tested: 



x (t) 



0.0 

= - 1.0 

0.0 

L 



1.0 

-0. 5 

0.0 



0.0 

1.0 x (t) 

1.0 



2.0 

0.0 

0.0 



L 



i.o 1 

1.0 u (t) 

0.0 



4 0 



H t) 



r 



0.0 1.0 0.0 

= 1 .0 1.0 0.0 x (t 

2.0 1.0 0.0 " 



lincon 

EXECUTION BEGINS... 

LINCON CONSISTS OF THE FOLLOWING SUBPROGRAMS: 

BASIC MATRIX MANIPULATION - < B ASM AT> 

RATIONAL TIME RESPONSE - <RTRESP> 

STATE VARIABLE FEEDBACK - <3TVAR> 

CONTROLLABILITY AND OBSERVABILITY - <OBSCON> 

LUENBERGER OBSERVER - <LUEN> 

OPTIMAL CONTROL/KALMAN FILTERS - <RICATI> 

DISCRETE TIME KALMAN FILTER - <KALMAN> 

OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <PRFEXP> 

ROOTS OF A POLYNOMIAL - <ROOTS> 

TO USE ONE OF THE SUBPROGRAMS ENTER THE NAME BETWEEN THE 
SYMBOLS < > . 
obscon 

03 SCON DETERMINES THE OBSERVABILITY INDEX AND 
CONTROLLABILITY OF A SYSTEM. 

FIRST ENTER THE PROBLEM IDENTIFICATION 
(* NOT TO EXCEED 2D CHARACTERS*) 
thesis exa irple 

NOW, ENTER THE ORDER OF THE SYSTEM (UP TO 8). 






0.0 



1.0 



0.0 



ENTER THE 
A (1,1) = 

A (1,2) = 

A (1,3) = 



A (2, 1) = 

- 1.0 

A A (2,2) = 

-0 . D 



1.0 



0.0 



0.0 



1.0 



A (2,3) = 



A (3,1) = 



A (3,2) = 
A (3,3) = 



ELEMENTS OF THE 



PLANT MATRIX-- A. 



4 1 



THE A MATRIX fPLA NT MATRIX) 
0.0 1. OOE+OO 0.0 

- 1. 00E+00 -5.00E-01 1 . OOE + OO 

0.0 0.0 1. OOE+OO 



n 



DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 
ENTER THE NUMBER OF COLUMNS OF THE B MATRIX. 



2.0 



1.0 



0.0 



1.0 



0.0 



0.0 



ENTER THE ELEMENTS OF THE B MATRIX. 
B (1,1) = 



B (1 , 2) = 



B (2, 1) = 



B (2 , 2) = 



B (3, 1) = 



B (3,2) = 



THE B MATRIX 

2. OOE+OO 1. OOE+OO 
0.0 1. OOE+OO 

0.0 0.0 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



ENTER THE NUMBER OF OUTPUTS. 



0.0 



ENTER THE ELEMENTS OF THE C MATRIX. 
C(1, 1) = 



1.0 



c ( 1 , 2) = 



0.0 



C ( 1 , 3) = 



1.0 



1.0 



0.0 



C ( 2, 1) = 
C (2,2) = 



C (2, 3) = 



o $< 3 ' * 

- 2.0 



1.0 



0.0 



c (3, 2) = 
C (3, 3) = 



i2 



THE C MATRIX 



0.0 1.00E+00 0.0 

1.00E+00 1. 00E+00 0.0 

-2.00E+00 1.00E+00 0.0 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



OBSERVABILITY INDEX = 2 

THE SYSTEM (A, 3| IS UNCONTROLLABLE 

DO YOU WANT TO RUN OB5CON AGAIN? 



THIS CONCLUDES THE OBSERVABILITY INDEX/CONTROLLABILITY 
PROGRAM (OBSCON) 

ANALYSIS IS COMPLETE. DO YOU WANT TO RUN LIKCON AGAIN? 



LINCON IS NOW TERMINATED. 

The complete results presented in Appendix E should 



be self-explanatory to the user. 
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C. OPTIMAL CONTROL/KALMAN FILTER PROGRAM (RICATI) 

The transient solution, matrix gains, to the Riccati 
differential equations for the state-regulator controller 
and the continuous Salman filter are calculated by the 
RICATI program. 

Given a state- regulator problem with the linear, time- 
invariant system 



X Ct ) = AX (t) *■ 3U (t) 

Z(t) = Cx(t) 

the Riccati equation is defined as 
I(t) = -P(t )A-A T £(t) +P (t) BR-iff"? (t) -2 



(4.C-1) 
(4. C-2) 



(4. C-3) 



with P (t 0 ) as the boundary condition. If u(t) is not 

constrained, a gain matrix can be found such that the cost 
function 

J= 1/2( x T (t^ )P (t 4 ) x (t^ | ]+ 1/2 / [ x T ( t) 25 ( t) +u T (t) Ru (t) ldt (4. C-4 ) 

% 

is minimized [ 5], Such a gain matrix is defined as 



G c (t) = R~ 1 B P (t) 



(4. C-5) 



and 



U (t) = -S c (t)x(t) 



(4. C-6) 



The transient solution is solve! by the computer. Note that 
the output from the computer for the gain matrix does not 
include the negative sign of the feedback loop. 

Given a continous Kalman filter problem with the linear, 
time-invariant system 



x (t) = 


Ax (t) 


+ Bw (t) 




(4. C-7) 


1 (t) = 


CX (t) 


* Z< t) 




(4. C-8) 


where w (t) , 


the random process for 


cing input and 


v(t) , the 


measurement 


noise, 


have covariance 


matrices of R , 


the random 


input covariance 


matrix, and 2, 


the measurement noise 


covariance 


matrix. 


r espectf ulL y , 


the Riccati 


equation is 



defined as 

Jt __ _ T — t _ 

P(t) = AP(t)+P(t) A B -P (t) C S-iCP(t) (4.C-S) 

with 

I (t 0 ) = 2 ([x(t 0 )-x ]; i (%> -I ] T f (4. c -io) 

as the initial condition Doundary. The gain matrix found is 
defined as 
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G + (t) = f-iCP(t) 



(4.C-11) 



1. Ter minal Session Examgle 

This section contains a session for the specific 
example presented by Melsa [ 1]. Commands entered by the 
user are in lower case. Given the second order linear system 



. r - 1.0 o.o’ r 1.0 O.O 1 

I(t) = 5(t| + u(t) 

0.5 0. 0 0. 0 1.0 

L 4 L J 



r 1.0 o.o 1 

z(t) = n n ,, n I(t) 

0.0 2.0 

L j 



determine the optimal transient response control and filter 
gains for 



2 = 2 = 



r 1 . 0 1 . 0 1 

1.0 1.0 

L J 



R = R = 



r i.o o.o 1 

0.0 2.0 

l i 



For the control option an initial time of 0.0 and a final 
time of 10.0 is used. For the filter option an initial time 
of 0.0 and a final time of 5.0 is used. Also, for the filter 
option, the initial condition matrix is chosen to be 



d& 



£ (% ) 



r 0.0 0 . 3 1 

0.0 0.0 

L J 



For both options tan equally spaced values of G and 
the time interval t < t < t are used, i.s., NPOINT : 
equal to 10. 



lincon 



EXECUTION 
LINCON CO 
BASIC a 
RATIONA 
STATE V 
CONTROL 
LUENBER 
OPTIMAL 
DISCRET 
OPTIMAL 
PARTIAL 
ROOTS O 
TO USE ONE 
SYMBOLS < 
r icati 



BEGINS. . . 
NSISTS OF T 
ATRIX MANIP 
L TIME RES? 
ARI ABLE FEE 
LABILITY AN 
GER OBSERVE 
CONTROL/KA 
E TIME KALM 
CONTROL - 
FRACTION E 
F A POLY NO M 
OF THE SUB 
>. 



HE FOLLOWING SUBPROGRAMS: 
ULATION - < B ASMAT> 

ONSE - < R T R ES P> 

DBACK - <5 T V AR> 

D OBSERVABILITY - <OBSCON> 

R - <LUEN> 

LM AN FILTERS - <RICATI> 

AN FILTER - <K ALM AN> 

<OPTCON> 

XP AN SION - < PRFEXP> 

IAL - <RO0TS> 

PROGRAMS ENTER THE NAME BETWEEN 



RICATI DETERMINES THE TRANSIENT SOLUTION FOR THE R] 
EQUATION. FIRST ENTER THE PROBLEM IDENTIFICATION 
(*NOT TO EXCEED 20 CHARACTERS*) 
thesis exa iple 

NOW, ENTER THE ORDER OF THE SYSTEM (UP TO 8). 

ENTER THE ELEMENTS OF THE PLANT MATRIX-- A. 

, £ 0 / 1 ) = 

- 1.0 



0.0 



0.0 



Ml, 2) = 



A (2, 1) = 



A (2,2) = 

- 2.0 

THE A MATRIX (PLANT MATRIX) 
-1.00E+00 0.0 

0.0 -2.00E+30 



DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



ENTER THE NUMBER OF CONTROL INPUTS. 



'4 7 



3 on 
s set 



HE 

CCATI 



2 



1.0 



0.0 



0.0 



1.0 



ENTER THE ELEMENTS OF THE DISTRIBUTION MATRIX — B. 

3(1, 1) = 

3(1,2) = 

3(2, 1) = 

B (2, 2) = 

THE B MATRIX (DISTRIBUTION MATRIX) 



1.00E+00 0.0 

0.0 1.00E+00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

I 

ENTER THE NUMBER OF OBSERVA3LE OUTPUTS. 

I 

ENTER THE ELEMENTS OF THE MEASUREMENT MAT RIX--C. 
C(1,1) = 



1.0 



0.0 



0.0 



2.0 



c (1,2) = 



C (2, 1) = 



C (2,2) = 



THE C MATRIX (MEASUREMENT MATRIX) 



1.00E + 00 0.0 

0.0 2. 00E+00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 
n 

YOU HAVE TWO OPTIONS AVAILABLE: 

(1) THE CONTROL OPTION FOR SOLVING STATE-REGULATOR 
PROBLEMS, OR 

(2) THE FILTER OPTION FOR SOLVING A CONTINUOUS KALMAN 
FILTER PROBLEM. 

FOR THE CONTROL OPTION, ENTER THE LETTER C. 

FOR THE FILTER OPTION, ENTER THE LETTER F. 



1.0 



0.0 



0.0 



ENTER THE ELEMENTS OF THE CONTROL WEIGHTING MATRIX-- R. 

R (1, D = 

R (1 , 2) = 

R (2, 1) = 



2.0 



R (2,2) = 



'4 3 



THE R MATRIX (CONTROL WEIGHTING MATRIX) 

1.00E+00 0.0 

0.0 2. 00E+00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

i 

ENTER THE ELEMENTS OF THE STATE WEIGHTING MATRIX — Q 

Q<1, D = 



1.0 



1.0 



1.0 



1.0 



Q(1,2) = 



Q (2, 1) = 



Q (2, 2) = 



THE Q MATRIX (STATE WEIGHTING MATRIX) 



1.00E+00 1. 00E+00 

1.00E+00 1.00E+00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



0.0 



ENTER THE INITIAL TIME FOR THE TRANSIENT RESPONSE. 



ENTER THE FINAL TIMS FOR THE TRANSIENT RESPONSE. 

10.0 



10 



ENTER THE NUMBER OF POINTS OF THE TRANSIENT RESPONS 
TO BE PRINTED. (<100) 

*###*## ***##*#*#** ###£ 

*** CONTROL OPTION *** 

ENTER THE ELEMENTS OF THE TERMINAL BOUNDARY VALUE 
MATRIX--?. 



0.0 



0.0 



0.0 



0.0 



P (1,1) = 



P(1,2) = 



? ( 2 , 1 ) = 



P(2,2) = 



THE P MATRIX (TERMINAL BOUNDARY VALUE MATRIX) 

0.0 0.0 

0.0 0.0 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 
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TRANSIENT SOLUTION 
TIME = 1.000E+01 



GAINS 

0.0 

0.0 


0. 0 
0. 0 


TIME = 


9. OOOE+OO 


G AI NS 
3. 75E-01 
1 .40E-01 


2. 81E-01 
1. 1 IE-01 


TIME = 


8. OOOE+OO 


GAINS 
3. 98E-01 
1. 42E-01 


2. 85E-01 
1. 12E-01 


TIMS = 


7. 000E+-03 


GAINS 
4. OOE-OI 
1 .423-01 


2. 85E-01 
1 . 12E-0 1 


TIME = 


6. OOOE+OD 


GAINS 
4. OOE-OI 
1 . 42E-01 


2. 85E-01 
1. 12E-01 


TIME = 


5. OOOE+OO 


GAINS 
4. 00 E- 01 
1 . 42E-01 


2. 85E-01 
1 . 1 2E-0 1 


TIME = 


4. OOOE+OO 


GAINS 
4. 0OS-O1 
1.42E-01 


2. 85E-01 
1. 12E-01 


TIME = 


3. 0 OOE* 00 


GAINS 
4. OOE-OI 
1.42S-01 


2. 85E-01 
1 . 1 2E-0 1 


TIME = 


2. OOOE+OO 


GAINS 
4 . OOE-OI 
1.42S-01 


2. 85E-01 
1. 1 2E-0 1 


TIME = 


1. 000E*03 


GAINS 
4. OOE-OI 
1.42E-01 


2. 85E-01 
1 . 1 2E-0 1 


TIMS = 


2. 86 IE- 06 


GAINS 
4 . OOE-OI 
1 . 42E-01 


2. 35E-01 
1. 12E-01 



5*2* # I*## 2* # :$c ## $: * ####:*£ * :$: 
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DO YOU WANT THE FILTER OPTION? 

y 

WILL THERE 3E CHANGES TO THE A , B , OR C MATRICES? 

n 

WILL THERE BE CHANGES TO THE R OR Q MATRICES? 

n 

ENTER THE INITIAL TIME FOR THE TRANSIENT RESPONSE. 

0.0 

ENTER THE FINAL TIME FOR THE TRANSIENT RESPONSE. 

5.0 

ENTER THE NUMBER OF POINTS OF THE TRANSIENT RESPONSE TO 
BE PRINTED. (<100| 

10 

*** FILTER OPTION *** 

**$$$* ate***#*##**** 

ENTER THE ELEMENTS OF THE INITIAL BOUNDARY VALUE 
MATRIX — P. 

A P<1,1) = 

0.0 

_ ?( 1 , 2 ) = 

0.0 

A n P (2,1) = 

0.0 

A ? (2,2) = 

0.0 

THE P MATRIX (INITIAL 30JNDARY VALUE MATRIX) 

0.0 0.0 

0.0 0.0 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



TRANSIENT SOLUTION 



TIME = 


o 

• 

o 


GAINS 


0.0 


0 . 0 


0.0 


0 . 0 


TIME = 


5. 000E-01 


GAINS 


2.39E-01 


2. 00E-01 


8. 02E-01 


6. 85E-01 


TIME = 


1. 000E+03 


GAINS 


2.7 IE-01 


2. 1 3E-31 


8 . 5 IE- 01 


7. 05E-01 


TIME = 


1. 500E+00 


GAINS 


2.77E-01 


2. 1 3E-0 1 


8. 5 3 E- 01 


7. 06E-01 
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TIME = 


2. OOOE+OO 


GAINS 


2. 78E-01 


2. 1 3E-0 1 


8.53E-01 


7. 06E-01 


TIME = 


2. 500E+00 


GAINS 


2.79E-01 


2. 13E-01 


8.53E-01 


7. 06E-01 


TIME = 


3. 000E+00 


GAINS 


2.79E-01 


2. 1 3E-D 1 


8.53E-01 


7. 06E-01 


TIME = 


3. 500E + 00 


GAINS 


2.79E-01 


2. 13E-01 


8.53E-01 


7. 06E-01 


TIME = 


4. OOOE+OO 


GAINS 


2. 79 E- 01 


2. 1 3E-0 1 


8.53E-01 


7. 06E-0 1 


TIME = 


4. 500E+00 


GAINS 


2. 79E-01 


2. 13E-01 


8.53S-01 


7. 06E-0 1 


TIME = 


5. OOOE+OO 


GAINS 


2.79S-01 


2. 1 3E-01 


8.53E-01 


7. 06E-01 



#*** ** ********************************************* *#* *** 

DO YOU WANT THE CONTROL OPTION? 
n 

THIS CONCLUDES THE RICCATI EQUATION PROGRAM (RICATI) . 

ANALYSIS IS COMPLETE. DO YOJ WANT TO RUN LINCON AGAIN? 
n 

LINCON IS NOW TERMINATED. 

The computer results for both options presented in 
Appendix F indicates that a steady state gain matrix has 
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been achieved 



D. DISCRETE TIME KALMAN FILTER . (KALMAN) 



The discrete Kalman filter gain matrix, G(k) , is 

calculated by this program. The theoretical concepts 
involved in the development of the computer codes are 
described by Sage [5]. A brief development of the discrete 
Kalman filter is included here as an aid in the use of 
KALMAN. Additional reference materials can be found in the 
bibliograph y. 

Kalman filtering is . a method of obtaining 
minimum-variance estimates of signals from noisy 
measurements. The discrete Kalmar, filter provides state 
estimates for the foLlowing system 



x (k) = §x (k-1) +Au (k— 1 ) +Cw(k- 1) 



(4. D-1) 



with the discrete linear observations 



z (k) - Hx (k) + v (k) 



(4. D-2) 



where 



x = the nxl state vector at the time t (k) 

§ = the nxn nonsingular state transition matrix 
T = the nxr disturbance transition or distribution matrix 
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A = the nxp control iistributioa matrix 



\ 



w = the rxl disturbance of system random input vector 

z = the mx 1 measurement vector 

H = the mx 1 measurement or observation vector 

v = the mxl measurement noise vector 

u = the px 1 control or test signal vector 

k = the discrete-time index (k = 0,1,...) 

The optimal filtered estimate of x(k), denoted 
x(k|k), is given by the recursive relations 



for k = 0,1,..., where x(0,0) = 0. The Kalman gain matrix, 

G(k), is an nxm matrix which is specified as 




(4. D-3) 



and 



x (k | k) = x ( k| k- 1) + 3 ( k) [ z (k) -Hx (k| k-l) ] 



(4. D-4) 



G(k) =P (k| k- 1) H T [HP (k |k -1) a T +8 (ki ]-i 



(4. D-5) 



P(k| k) = [ I-G(k) H]P (k | k-1) 

P (k | k- 1) = §P<k-1 1 k — 1 » | +2(k,k-1) 



(4. D-7) 



(4. D-6) 



where 
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< Ml < Ml 



I = the nxn identity matrix 

P(0|0) = P(0) , the initial condition matrix 

(k|k-1) = the single-stage prediction of x(k) 

(k | k) = the filtered estimate of x (k) 

0 = r3{w (k) w(k) T }P' r , the nxn covariance matrix of the 

random in pat 

R = the mxn covariance matrix of the measurement noise 

E (w (k) v (k) T } , the mean-square magnitude of the perfurbat 
acceleration matrix 

1. Injout Peauirea ents 

This program compures the recurrence 
(U.D-5) , (4. D-5) and (4.D-7) for a specified number 
iterations NP and prints 3{k) as a function of k. 

The required inpurs are 

1) the transition matrix (f) 

2) the distribution matrix (C) 

3) E{v (k) w ( k» T } 

4) the observation matrix (H) 

5) the number of points to be performed (NP) 

and 

6) the initial condition matrix [P(3(0) ]. 



ion 

Eqs. 

of 



2. Terninal Session Example 

This section contains a session for a specific 
problem. Commands entered by the user are in lower case. 
The following system is to be tested: 



x (k) 



r 1 .0 

0 .0 



.5 1 

1.0 s 01 ' 1 ’ 

J 



r 0. 125'’ 
3.5 

L J 



w (k-1) 



z (k) = [ 1 .0 0.0] i ( k) f y (k) 

R = [5.0 ] 



B{w(MS(k) T } = 4. 0 



P (0) 



r 1000.0 

0 . 0 



3.0 1 

1000.3 



The number cf time points to be computed is chosen to be 20. 



iinco n 

EXECUTION BEGINS... 

LINCON CONSISTS OF THE FOLLOWING SUBPROGRAMS : 

BASIC MATRIX MANIPULATION - < E AS MAT> 

RATIONAL TIME RESPONSE - <RTRESP> 

STATE VARIABLE FEEDBACK - <3TVAR> 

CONTROLLABILITY AND OBSERVABILITY - <OBSCON> 

LUENBERGER OBSERVER - <LUEN> 

OPTIMAL CONTROL/KALMAN FILTERS - <RICATI> 

DISCRETE TIMS KALMAN FILTER - <KALM AN> 

OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <?RFEX?> 

ROOTS OF A POLYNOMIAL - <RO0TS> 

TC USE ONE OF THE SUBPROGRAMS ENTER THE NAME BETWEEN THE 
SYMBOLS < >. 
kalman 

KALMAN DETERMINES THE DISCRETE KALMAN FILTER GAIN MATRIX 
— G ( K) . FIRST ENTER THE PROBLEM IDENTIFICATION 
(*N0T TO EXCEED 23 CHARACTERS*), 
thesis exa mpie 

NOW, ENTER THE ORDER OF THE SYSTEM (UP TO 8). 
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ENTER THE ELEMENTS OF THE TRANSITON MATRIX — PHI 
PHI ( 1 , 1 ) = 

1 • 

PHI (1, 2) = 

.5 

_ PHI (2, 1 ) = 

0.0 

1 PHI (2,2) = 

THE PHI MATRIX (TRANSITION MATRIX) 

1.00E+00 5. 03B-01 

0.0 1 . 00 E +00 

DO YOO WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 
n 

ENTER THE DIMENSION OF THE RANDOM INPUT VECTOR. 

1 

ENTER THE ELEMENTS OF THE DISTRIBUTION MATRIX — GAMMA. 
GAMMA (1,1) = 

.125 

GAMMA (2 ,1) = 

• 3 

THE GAMMA MATRIX (DISTRIBUTION MATRIX) 



n 



4 . 



1. 25E-0 1 
5. OOE-O 1 



DO YOU WANT TO CHANGE ANY ELEMENT 



OF THE MATRIX? 



ENTER THE ELEMENTS OF THE MEAN-SQUARE MAGNITUDE OF THE 
PERTURBATION ACCELERATION MATRIX — W. 

W(1,1) = 



THE W MATRIX (MEAN-SQUARE MAGNITUDE OF THE 
PERTURBATION ACCELERATION MATRIX) 

4 . 00 E+ 0 0 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

r> 

im 

ENTER THE NUMBER OF OUTPUTS. 

1 

ENTER THE ELEMENTS OF THE OBSERVATION MATRIX--H. 

H(1,1) = 

I • 

o. 

THE H MATRIX (OBSERVATION MATRIX) 

1.00E+00 0.0 
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n 



DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



ENTER THE ELEMENTS OF THE MEASUREMENT NOISE COVARIANCE 
MATRIX — R. 

R(1, D = 



THE R MATRIX (MEASUREMENT NOISE COVARIANCE MATRIX) 
5. 00E+00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

n 

ENTER THE NUMBER OF THE POINTS TO BE PERFORMED. 

„ A <<10 0 ) 

20 



ENTER THE ELEMENTS OF THE INITIAL CONDITION MATRIX-- P. 

P(1,1) = 

0 . 

P ( 1 , 2) = 

P(2, 1) = 



P 

1000 



( 2 , 2 ) = 



THE P MATRIX (INITIAL CONDITION MATRIX) 



1.00E+03 0.0 

0.0 1 . 00 E +03 

DO YOU WANT TO CHANGE 



ANY ELEMENT OF THE MATRIX? 



n 



K = 0 

GAINS 

9.95E-01 0.0 



K = 1 

GAINS 

9.31E-01 1 . 92 E +00 



X = 2 

GAINS 

3. 29 E- 0.1 9. 93 E -01 



K = 3 

GAINS 

7.03E-0 1 6 . 2'4 E -0 1 



K = 4 

GAINS 

6.13E-01 4.52E-01 
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K = 5 

GAINS 
5. 54E-0 1 



K = 6 

, GAINS 

5. 18E-0 1 



K = 7 

GAINS 
4. 99E-0 1 



K = 8 

GAINS 
4. 90 E- 0 1 



K = 9 

GAINS 
4. 87E-0 1 



K = 10 

GAINS 
4. 86E- 0 1 



K = 11 

GAINS 
4. 36E-0 1 

K = 12 

GAINS 
4.86E-0 1 



K = 13 

GAINS 
4. 86E-0 1 



K = 14 

GAINS 
4. 36E-0 1 

K = 15 

GAINS 
4.36 5-0 1 

K = 16 

GAINS 
4. 36E-0 1 



K = 17 

GAINS 
4. 36E-0 1 



K = 18 

GAINS 
4. 86E-0 1 



3. 72E-01 
3. 35E-01 
3. 23E-01 
3. 205-01 
3. 23E-01 
3. 215-01 
3. 215-01 
3.215-01 
3. 215-01 
3. 215-01 
3. 215-01 
3. 215-01 
3. 215-01 
3. 215-01 



K = 19 

GAINS 
4. 86E-0 1 



3. 21E-01 



K = 20 

GAINS 

4.86E-01 3.21E-01 

THIS CONCLUDES THE DISCRETE SALMAN FILTER PROGRAM 
(KALMAN). 

ANALYSIS IS COMPLETE. DO YOJ WANT TO RUN LINCON AGAIN 
LINCON IS NOW TERMINATED. 

The computer results are presented in Appendix 3. 
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STATE VARIABLE FEEDBACK PRD3RAM ( STVAR) 



Given the linear t ime- invar! an t system 

x (t) = Ax (t ) + bu (t) (4.E-1) 

u (t) = K;r(t) - k T x(t) ] (4. E-2) 

y (t) = c T x(t) (4.E.3) 

the following can be performed by STVAR 

(1) calculation of the plant franfer function, Y(s)/U(s) 

(2) by defining a ficticious c vector the infernal 
transfer function can be calculated, X;(s)/U(s); for 
example, if X 3 (s)/U(s) is desired the c matrix is 
selected with c 3 = 1 and all other c elements equal 
to zero; or if X,(s>/X 3 (s) is desired, calculate 
X,(s)/U(s) and X 3 (s)/U(s) and divide the two 

(3) calculation of the closed-loop transfer function, 
Y(s)/R (s) 

(4) calculation of the feedback transfer function, 
H e<j (S) 

(5) for a desired closed-loop transfer function, the 

controller gain and feedback coefficients in 
addition to (s) can be calculated; the 



feedforward gain is selected so that a zero steady 
state error results from a step input; the designer 
who wishes other conditions must rescale the gain 
and feedback coefficients appropriately; for 
example, if it is desired to have K = 1.0 but it is 
calculated as K = 2.0 with feedback coefficients of 
k = 0.5, k =0.0 and k = 1.5, the procedure to 
modify the results would be 

2 . 0 

k = [0.5 0.0 1.5] 

“ 1.0 

=[1.0 0.0 3.0] 

All of the information necessary for the user to solve 
stare variable feedback problems is presented in this 
section. However, the theoretical concepts involved in the 
development of the computer cedes are fully described by 
Melsa [ 7]. 

The basic input contains the problem identification, 
matrices A and b and the order of the plant, n. These four 
inputs are required regardless of what open- or closed-loop 
calculations are to be made. 

At this point STY A R verifies the controllability of the 
system. Three controllability conditions are possible 

(1) complete controllability 
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(2) numerically an controllable 

and 

(3) unc cntrollabil ity 

Contollability arises when the controllability matrix 

E = [ b Ab A 2 b ... A" - 1 b ] (4.2-4) 

is nonsingular, i.e., detE * 0. Even if the matrix is 
nonsingular problems may arise if it is difficult to invert. 
To check this STVA8 multiplies the matrix by its calculated 
inverse. The result should be the identity matrix. The 
actual matrix product is compared with the identity matrix 
to provide a measure of uncontrollability. If the maximum 
value of deviation is not negligible, the plant is 
identified as numerically uncontrollable, A deviation larger 
than 10 -3 to 1 0 -5 hae been found to indicate difficulty by 
Melsa C 1]* 

User beware: I? the system is identified as being 

uncontrollable, all open- and closed-loop calculations are 
still perf o rmed ! 

There are three possible closed-loop options available, 
one for analysis purposes only and the other two for design 
purposes. After choosing the analysis option, and supplying 
STVAR with the feedforward gain K and feedback coefficient 
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matrix k, the program calculates the closed-loop 
characteristic polynomial and the numerator of the 
equivalent feedback transfer function. 

The two design options are used to calculate the 
controller gain and the feedback coefficients necessary for 
a desired closed-loop characteristic polynomial. The 
polynomial may be entered in either polynomial form or 
factored form. 

1. Terminal Session 5 xa mple 

This section contains a third order system for 
analysis by STVAR as presented by Melsa * 1]. The state 

variable representation of the plant is given by 



* r - 1.0 
x(t) = 0.0 

0 .0 



1.0 

0.0 

- 3 . 0 



o.o 1 r o.o 1 

1.0 x (t| + 0.0 u (t ) 

0.0 ~ 1.0 ■ 

J L J 



2 (f) = [ 1.0 1.0 0.0] x(t| 

For the open-loop case, it is desired to find the 
internal transfer function X (s) /U (s) and the plant transfer 
function Y(s)/U(s). A ficticious matrix, necessary to find 
the internal transfer function, is then 

c = [0.0 0.0 1.0] 
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In addition, find the values of the feedforward gain and the 
feedback coefficients required to give a closed-loop 
transfer function of 



lincon 

EXECUTION BEGINS... 

LINCON CONSISTS OF THE FOLLOWING SUBPROGRAMS: 

BASIC MATRIX MANIPULATION - <B ASM AT> 

RATIONAL TIME RESPONSE - <RTRESP> 

STATE VARIABLE FEEDBACK - <5TVAR> 

CONTROL LABILITY AND OBSERVABILITY - <OBSCON> 

LUENBERGER OBSERVER - <LUEN> 

OPTIMAL CONTROL/KALMAN FILTERS - <RICAII> 

DISCRETE TIME KALMAN FILTER - <KALM AN> 

OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <?RFEXP> 

ROOTS OF A POLYNOMIAL - <R00TS> 

TO USE ONE OF THE SUBPROGRAMS ENTER THE NAME BETWEEN THE 

SYMBOLS < >. 

stvar 

STVAR DETERMINES INTERNAL TRANSFER FUNCTIONS, 

THE PLANT TRANSFER FUNCTION, THE CLOSED-LOOP TRANSFER 
FUNCTION, AND THE EQUIVALENT FEEDBACK TRANSFER FUNCTION. 
IN ADDITION. THE CONTROLLER GAIN AND THE FEEDBACK 
COEFFICIENTS NECESSARY TO ACHIEVE A SPECIFIED CLOSED- 
LOOP TRANSFER FUNCTION ARE CALCULATED. 

FIRST ENTER THE PROBLEM IDENTIFICATION 
(♦NOT TO EXCEED 23 CHARACTERS*) . 
thesis exa nple 

NOW, ENTER THE ORDER OF THE SYSTEM (UP TO 8). 



Vil) 



2 (s +2) 

S 3 + 43 2 + 6s + 4 



3 



— 1 



ENTER THE ELEMENTS OF THE PLANT MATRIX-- A 
A (1,1) = 



A (1,2) = 



0 



A (1/3) = 



0 



A (2,1) = 



0 



A (2,2) = 



A (2,3) = 



0 



A (3,1) = 
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- 3 . 



A (3,2) = 



0 

0 

1 



A (3,3) = 



THE A MATRIX (PLANT MATRIX! 

- 1 . OOE + OO 1.00E + 00 0.0 

0.0 0.0 1. 00E+00 

0. 0 -3. OOE+OO 0.0 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

ENTER THE ELEMENTS OF THE CONTROL VECTOR — B. 

B(1) = 

B ( 2) = 

B (3) = 

THE B MATRIX (CONTROL MATRIX) 

0.0 
0 . 0 

1 . OOE+OO 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



n 



****=Sc^** ** * ** I******** * **** *^c*#*^***^c*****^c*#**4c**^c*** *** 

OPEN-LOOP CALCULATIONS 

DENOMINATOR COEFFICIENTS - IN ASCENDING POWERS OF S 
3. OOE+OO 3. OOE+OO 1. OOE+OO 1. OOE+OO 



THE ROOTS ARE 



REAL PART IMAG. PART 
0.0 -1.73E+00 

0.0 1.73E+00 

-1. OOE+OO 0.0 



DO YOU HAVE A FICTICIOUS OUTPUT VECTOR TO ENTER? 



0 

0 

1. 



n 



ENTER THE ELEMENTS OF THE FICTICIOUS OUTPUT VECTOR-- C. 

C ( 1) = 

C (2) = 

C (3) = 

THE C MATRIX (FICTICIOUS OUTPUT VECTOR) 

0.0 
0 . 0 

1 . OOE+OO 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

NUMERATOR COEFFICIENTS - IN ASCENDING POWERS OF S 
0.0 1. OOE+OO 1. OOE+OO 



So 



THE HOOTS ARE 



n 

1 . 

1 . 

0 



n 



REAL PART 
-1 . OOEOO 
0.0 

DO YOU HAVE ANOTHER FICTICIOUS 



ENTER THE ELEMENTS OF THE TRUE 



C(1) = 



IMAG. PART 
0.0 
0.0 

MATRIX TO ENTER? 



OUTPUT VECTOR--C. 



C (2) = 

C(3j = 

THE C MATRIX (OUTPUT VECTOR} 

1. 00E+00 
1 . 00E + 00 
0 . 0 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



P 



4. 



NUMERATOR COEFFICIENTS - IN ASCENDING POWERS OF S 
2. COE + OO 1. OOE + OO 

THE ROOTS ARE REAL PART IMAG. PART 

-2.00EO0 0.0 

THIS PROGRAM IS CAPABLE OF PERFORMING THREE TYPES 
OF CLOSED-LOOP CALCULATIONS. ONE TYPE FOR THE ANALYSIS 
MODE. THE OTHER TWO FOR DESIGN. 

ENTER ONE OF THE FOLLOWING MODES: 

1) A — FOR THE ANALYSIS MODE 

2) ? — FOR THE DESIGN MODE WITH THE UNFACTORED 

CLOSED-LOOP CHARACTERISTIC POLYNOMIAL 

3) F -- FOR THE DESIGN MODE WITH THE FACTORED 

CLOSED-LOOP CHARACTERISTIC POLYNOMIAL 



CLOSED-LOOP CALCULATIONS 
KEY = P ***** 

ENTER THE DESIRED CLOSED-LOOP CHARACTERISTIC POLYNOMIAL 
COEFFICIENTS IN ASCENDING POWERS OF S. 

YOUR HIGHEST ORDER COEFFICIENT MUST BE A VALUE OF ONE. 
POLY (1) = 



POLY (2) = 
POLY (3) = 



POLY (4) = 



THE NUMERATOR OF H- EQUIVALENT - 
IN ASCENDING POWERS OF S 

5.00E-01 1.5 0E + 00 1.50E + 00 

THE ROOTS ARE REAL PART IMAG. PART 

-5.00E-31 -2.89E-01 
-5.00E-01 2.89E-01 
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THE FEEDBACK COEFFICIENTS 

5.00E-01 0.3 1.50E+00 

THE GAIN = 2. 0 OOOOOE+OO 

THE CLOSED-LOOP CHARACTERISTIC POLYNOMIAL - 
IN ASCENDING POSERS OF S 

4 . 00 E + 0 0 6. 30E+00 4.33E+00 1.00E + 00 

THE ROOTS ARE REAL PART IMAG. PART 

-2.00EMJ0 0.0 

- 1 . 00E* 00 -1.00E+00 
-I.OOEfOO 1.00E+00 

MAXIMUM NORMALIZED ERROR = 0.0 

DO YOU WANT TO RUN ANOTHER MODE IN STVAR? 



THIS CONCLUDES THE STATE VARIABLE FEEDBACK PROGRAM 
(STVAR) . 

ANALYSIS IS COMPLETE. DO YOJ WANT TO RUN LINCON AGAIN? 



LINCON IS NOW TERMINATED. 

The computer results for this problem is presented 



in Appendix H. The open-loop portion indicates that the 



system is controllable, since 
uncontrollability, with the 
function of 



there is 
desired 



no indication of 
internal transfer 



X 3 (S) _ S2fS 

U ( s) s 3 +s 2 + 3s + 3 



and a plant transfer function of 



mode , 



Y ( s) _ s + 2 

U(s) ~ s 3 «■ s 2 + 3 s + 3 

The closed-loop portion, using the polynomial design 
shows that the feedforward gain and feedback 



53 



coefficient matrix raj uired to yield the desired closed- loop 



transfer function, Y(s)/R(s), are 

K = 2.0 



and 



0 .5 

k = 0.0 

1 .5 

L J 
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F. LUENBERGER OBSERVER PROGRAM (LUEN) 

When a particular closed-loop transfer function is 
desired and some of the states are inaccessible, LUEN can be 
used to design a Lueaberger Observer. For example, if q 
measurements are state variables, an observer of reduced 
dimensions can be designed to estimate only those states 
which are not measured. The state estimates generated by an 
observer can be used as input information to a 
controller [8]. The block diagram presented in Fig. 4-1 
represents the general form of the system when a compensator 
is placed in the feedback path. 




Fig. 4.1. Luanberger Observer Block Diagram 
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The plant is chara ct er ized ay the state and measurement 



equations 



I(t) 


= Ax (t) + B u (ti 


(4. F-1) 


Z(t) 


= QX(t) 


(4. F-2) 


z'(t) 


= C X (t) 


(4. F-3) 



An observer can 


be 


designed 


that generates an estiraa 


'te y. 


which converges to 


t ti 


e state x 


as time 


becomes large [ 


9]. 


A linear controller 


is 


des igned 


a s 






u(t) = K[r(t) 


- 


k T x(t) ] 




(4. 


F-4) 


in which all state 


s 


can be me 


asured. 


Replacing the 


true 



state with the estimate yields 

u(t) = K[r <t) - k T y(t) ] (4. F-5) 

where 

k T y(t) = h T y(t| + q z {t» (4.F-6) 

As time increases k T y(t) will approach k T x(t). Since the 
reduced-order observer estimates only the inaccesibls 
states, the control law contains measured states where 
available and observer estimates for the other states. 
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For ease in using LUES , 



the following are defined: 



X (t) 


= n-element column state vector 


u (t) 


= plant input 


Z (t) 


= g-vector of systen measurements 


Z' (t) 


= output variable to be controlled 


A 


= plant matrix (r. x n) 


b 


= distribution matrix (g x m) 

[assumptions: (1) g < n and (2) C has rank g] 


C 


= output, matrix 


r (t) 


= forcing function 


K 


= feedforward or controller gain 


k 


= feedback coefficient matrix(n x m) 


h 


= observer feedback coefficient matrix 


3 


= output feedoack coefficient matrix 



and 



1(h) 


= estimated state vector of x(t>. 
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From theory, the observer is described by 



2(t) = Fl(t) + S,z(t> ♦ G^a(t) (4. F-7) 

where 

F = observer eigenvalue matrix 

and 



G, and G x = observer gain matrices. 



Z* (s)/H{s) can be solved by the following procedure: 

(1) select Z'(s)/R(s) and solve for K and k by using the 
ST VAR program 

(2) use the 0B3C0N program to calculate the 
observability index; the observer is designed to 
have a dimension greater than or equal to the 
observability index minus one. 

(3) select the F eigenvalues; these should not equal 
those of A, previously calculated by SIVAR. 

(4) use LOEN to calculate G, , G ir h and g. 

1. Terminal Session Sx ample 

The example presented here is taken from Desjardins, 
pp . 147 [ 2]. Commands entered by the user are in lower 
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case. However, 


due to 


the 


special nature 


of 


the example. 


comments have 


been added 


to the terminal 


session for 


clarity. Given 


the fourth order plant 








r 3. 0 


1 .0 


0.0 0.0 




r o.o 1 




0 . 0 


3.0 


1.3 0.0 




0.0 


x(t) 






x (t) 


+ 


_ u (t) 


0 . 0 


3.0 


3.0 1.0 




0.0 




3. 0 


-15. 


-23. -9.0 




1.0 



with 

z*(t) = [ 10. 20. 0. 0 0.0 ] x(t) 

Because x, and x A are the only neasureable states 



1 (t) 



r 1.0 0.0 o.o o.o 1 

0.0 1.0 0.0 0.0 

U J 



X (t) 



The closed-loop transfer function to be achieved is chosen 
to be 



.-UfL 

R (s) 



1 



s 4 +3s 3 +17s 2 +28s+20 



lincon 

EXECUTION BEGINS... 

LINCON CONSISTS OF THE FOLLOWING SUBPROGRAMS : 
BASIC MATRIX MANIPULATION - <BASMAT> 

RATIONAL TIMS RESPONSE - <RTRSSP> 

STATE VARIABLE FEE DBAS K - <3TVAR> 
CONTROLLABILITY AND OBSERVABILITY - <OB3CON> 
LUENBERGER 03SERVSR - <LUEN> 

OPTIMAL CONTROL/KALMAN FILTERS - <RICATI> 
DISCRETE TIME KALMAN FILTER - <K ALM AN> 
OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <PRFEXP> 



ROOTS OF A POLY N03 IAL - <ROOTS> 

TO USE ONE OF THE SUBPROGRAMS ENTER THE NAME BETWEEN THE 
SYMBOLS < >. 
s- var 

STVAR DETERMINES INTERNAL TRANSFER FUNCTIONS , 

THE PLANT TRANSFER FUNCTION, THE CLOSED-LOOP TRANSFER 
FUNCTION, AND THE EQUIVALENT FEEDBACK TRANSFER FUNCTION. 
IN ADDITION, THE CONTROLLER GAIN AND THE FEEDBACK 
COEFFICIENTS NECESSARY TO ACHIEVE A SPECIFIED CLOSED- 
LOOP TRANSFER FUNCTION ARE CALCULATED. 

FIRST ENTER THE PROBLEM IDENTIFICATION 
(* NOT TO EXCEED 23 CHARACTERS*) . 

THESIS EXAMPLE 

NOW, ENTER THE ORDER OF THE SYSTEM (UP TO 8). 



ENTER THE ELEMENTS OF THE PLANT MATRIX- - A 



A{1,2) = 

■ • 

0 A(1,3) = 
0 A(1 ' 4) = 
0 A(2 ' 1) = 



0 

1. 



A (2, 2) = 
A (2, 3) = 



0 



A (2,4) = 



A (3,1) = 



o A(3 ' 2) = 

„ A (3,3) = 
A (3,41 . 



o i<4 ' ,,= 

. 1S A(4, 2 > = 

A (4, 3) = 

-2 j . 

„ A ( 4, 4) = 
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THE A MATRIX (PLANT MATRIX) 



0. 0 


1. OOE+OO 


0.0 


0.0 


0. 0 


0.0 


1 .OOE + OO 


0.0 


0. 0 


0. 0 


0. 0 


1. OOE+OO 


0. 0 


-1.5 0E + 01 


-2.30E+01 


-9. OOE+OO 



DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

n 

ENTER THE ELEMENTS OF THE CONTROL VECTOR — B. 

o B(,,= 

o B(2,= 

o B(3,= 

B (4) = 



THE B MATRIX (CONTROL MATRIX) 



0 . 0 
0 . 0 

1. 00E + 00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

n 






OPEN-LOOP CALCULATIONS 

DENOMINATOR COEFFICIENTS - IN ASCENDING POWERS OF S 

0.0 1.50E+01 2.30S+01 9. OOE+OO 1. OOE+OO 

THE ROOTS ARE REAL PART IMAG. PART 

-3.00E<-00 0.0 

-5.C0E+00 0.0 

-1. OOE+OO 0.0 

0.0 0.0 

DO YOU HAVE A FICTICIOUS OUTPUT VECTOR 10 ENTER? 
n 

ENTER THE ELEMENTS OF THE TRUE OUTPUT VECTOR — C. 



10 . 



C (2) = 



o c(3) = 



C(0) = 

THE C MATRIX (OUTPUT VECTOR) 
2.00E + 01 
1 . 00E + 01 
0 . 0 
0 . 0 
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n 



DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



NUMERATOR COEFFICIENTS - 13 ASCENDING POWERS OF S 
2. G0E + 01 1. 00E+0 1 

THE ROOTS ARE REAL PART IMAG. PART 

-2. OOEf 00 0.0 

THIS PROGRAM IS CAPABLE OF PERFORMING THREE TYPES 
OF CLOSED-LOOP CALCULATIONS. ONE TYPE FOR THE ANALYSIS 
MODE. THE OTHER TWO FOR DESIGN. 

ENTER ONE OF THE FOLLOWING MODES: 

1) A — FOR THE ANALYSIS MODE 

2) P -- FOR THE DESIGN MODE WITH THE UNFACTORED 

CLOSED-LOOP CHARACTERISTIC POLYNOMIAL 

3) F — FOR THE DESIGN MODE WITH THE FACTORED 

CLOSED-LOOP CHARACTERISTIC POLYNOMIAL 



CLOSED-LOO? CALCULATIONS 
KEY = P ***** 

ENTER THE DESIRED CLOSED-LOOP CHARACTERISTIC POLYNOMIAL 
COEFFICIENTS IN ASCENDING POWERS OF S. 

YOUR HIGHEST ORDER COEFFICIENT MUST BE A VALUE OF ONE. 
POLY ( 1 ) = 

20 . 

POLY (2) = 



POLY (3) = 



POLY (4) = 



POLY (5) = 



THE NUMERATOR OF H-E) UIVALENT - 
IN ASCENDING POWERS OF S 

2. COE ♦ 0 1 1.30E + 01 -5.30E + 00 -3.03E + OO 

THE ROOTS ARE REAL PART IMAG. PART 

-1.0 4 Et-00 0.0 

3.21E+00 0.0 

THE FEEDBACK COEFFICIENTS 

2. 00E + 01 1.30E+01 -5.00E+00 -3.00E+00 

THE GAIN = 1. 0 0000 OE + OO 

THE CLOSED-LOO? CHARACTERISTIC POLYNOMIAL - 
IN ASCENDING POWERS OF 3 

2.00E+01 2.30E+01 1. 705+01 6.00E+00 1.00E+00 
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THE ROOTS ARE REAL PART IMAG. PART 

-I.OOEOO -2.00E03 
-1.00E+00 2.00E+00 

-2. 00E*- 33 0.0 

-2.00E+00 0.0 

MAXIMUM NORMALIZED ERROR = 0.0 

DO YOU WANT TO RUN ANOTHER a DDE IN STVAR? 



THIS CONCLUDES THE STATE VARIABLE FEEDBACK PROGRAM 
(STVAR) . 



COMMENT: results indicate that the system is 

controllable, that the eigenvalues of A are -3.0, 
-5.0, -1.0 and 0.0, that the values of~k are 20.0, 
13.0, -6.0 and -3.0 and that K is equal to unitv; 
the observability index is next needed to desian the 
observer 



ANALYSIS IS COMPLETE. DO YOU WANT TO RUN LINCON AGAIN? 



LINCON CONSISTS OF THE FOLLOWING SUBPROGRAMS: 

BASIC MATRIX MANIPULATION - <BASMAT> 

RATIONAL TIME RESPONSE - <RTRESP> 

STATE VARIABLE FEEDBACK - <STVAR> 

CONTROLLABILITY AND OBSERVABILITY - <OBSCON> 

LUSNBER GER OBSERVER - <LUEN> 

OPTIMAL CONTROL/KALMAN FILTERS - <RICATI> 

DISCRETE TIME KALMAN FILTER - <KALM AN> 

OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <PRFEXP> 

ROOTS OF A POLYNOMIAL - <R00TS> 

TO USE ONE OF THE SUBPROGRAMS ENTER THE NAME BETWEEN THE 

SYMBOLS < >. 

obscon 

OBSCON DETERMINES THE OBSERVABILITY INDEX AND 
CONTROLLABILITY OF A SYSTEM. 

FIRST ENTER THE PROBLEM IDENTIFICATION 
(*NOT TO EXCEED 20 CHARACTERS*) . 
thesis exa mpie 

NOW, ENTER THE ORDER OF THE SYSTEM (UP TO 8) . 



ENTER THE ELEMENTS OF THE PLANT MATRIX-- A. 



A ( 1 , 2) = 

1 • 

o S(1 ' 3) = 



0 



A ( 1 , 4) = 



A (2,1) = 
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0 



A (2, 2) = 



1 . 

0 

0 

0 

0 

1 . 

0 



A (2,3) = 
A (2,4) = 
A (3, 1) = 
A (3, 2) = 
A (3,3) = 
A (3,4) = 
A (4 , 1) = 



A (4, 


2) = 




-15. 


. . A (4, 


3) = 




-23. 


A (4, 


4) = 




-y . 


THE 


A MATRIX (PLANT MATRIX) 


0.0 


1.00E+00 0.0 


0.0 


0.0 


0.0 1 .00E + 00 


0.0 


0.0 


0.0 0.0 


1 . OOE+OO 


0.0 


-1.50E+01 -2.30E+01 


-9. 00E+00 



DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 
n 

ENTER THE NUMBER DF COLUMNS OF THE 3 MATRIX. 

1 

ENTER THE ELEMENTS OF THE 3 MATRIX. 

o 3{1 ' 1,= 
o B(2 ' 1) = 

„ 3(3,1) = 



3 (4, 1) = 



THE 3 MATRIX 

0.0 

0.0 

0.0 

1 . 00E+00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 
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2 



ENTER THE NUMBER 3F OUTPUTS 



1 , 
0 
0 
0 
0 
1 , 
0 
0 



ENTER THE ELEMENT OF THE C MATRIX. 

C (1, 1) = 



C<1,2) = 
C (1,3) = 
C (1,4) = 
C ( 2, 1) = 
C (2, 2) = 
C (2,3) = 
C (2,4) = 



THE C MATRIX 
1.00E+00 0.0 0 .0 

0.0 1. 0 0E+00 0.0 



0.0 

0.0 



DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



OBSERVABILITY INDEX = 3 

THE SYSTEM (A , B) IS CONTROLLABLE 

********** :£****:$***£*** Ic***#******:*********:****:**:** ******* 

DO YOU WANT TO RON OB5CON AGAIN? 



THIS CONCLUDES THE OBSERVABILITY INDEX AND 
CONTROL LABILITY PROGRAM (035C0N) 

COMMENT; resales indicate an observability index 
3 ; EKis permits the design of a second ord 
observer; eigenvalues of -3.5 and -4.0 are chcs 
(not equal to those of the plant) as observ 
eig envaxues 

ANALYSIS IS COMPLETE. DO YOU WANT TO RUN LINCON AGAIN? 



LINCON CONSISTS OF THE FOLLOWING SUBPROGRAMS: 

3ASIC MATRIX MANIP ULAT ION - < B ASM AT> 

RATIONAL TIME RESPONSE - <RTRESP> 

STATE VARIABLE FEEDBACK - <3TVAR> 

CONTROLLABILITY AND OBSERVABILITY - <OBSCON> 
LUEN3ERGER 03SERVER - <LUEN> 

OPTIMAL CONTROL/KALMAN FILTERS - <RICATI> 

DISCRETE TIME KALMAN FILTER - <KALMAN> 

OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <?RFEX?> 

ROOTS OF A POLYNOMIAL - <R3DTS> 

TO USE ONE OF THE SUBPROGRAMS ENTER THE NAME BETWEEN THE 

SYMBOLS < >. 

luen 
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(P (0 O 
i-j rs ii i-h 



LUEN IS USED TO DESIGN LUENBSRGER OBSERVERS TO 
ACHIEVE A GIVEN CLOSED-LOOP TRANSFER FUNCTION WHEN SOME 
STATE VARIABLES ARE INACCESSIBLE. 

FIRST ENTER THE PROBLEM IDENTIFICATION 
(NOT TO EXCEED 20 CHARACTERS), 
thesis example 



4 

2 

2 

0 

1 

0 

0 

0 



ENTER THE ORDER OF THE SYSTEM (UP TO 8| . 
ENTER THE NUMBER OF MEASUREMENTS (UP TO 3) . 
ENTER THE ORDER OF THE OBSERVER (UP TO 8). 
ENTER THE ELEMENTS OF THE PLANT MATRIX-- A. 

A(1, D = 

A (1,2) = 

A (1,3) = 

A (1,4) = 

A (2, 1) = 



0 

1. 

0 

0 

0 

0 

1 . 

0 



- 15 
-23 

-9. 



A (2, 2) = 
A (2,3) = 
A (2,4) = 
A (3, 1) = 
A (3,2) = 
A (3,3) = 
A (3 , 4) = 
A (4, 1) = 

A (4 , 2) = 

« 

A (4,3) = 
A(4,4) = 



3 1 



n 



0 

0 

0 

1 . 



n 



1 . 

0 

0 

0 

0 

1 . 

0 

0 



THE A MATRIX 


(PLANT MATRIX) 




0. 0 


1. 00E+00 


0. 0 


0.0 


0. 0 


0. 0 


1 . DOE+00 


0.0 


0. 0 


0. 0 


0.0 


1. 00E + 00 


0. 0 


-1. 50E+01 


-2. 30E+01 


-9. 00E+00 



DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

ENTER THE ELEMENTS OF THE DISTRIBUTION MATRIX — B. 
B(1) = 

B (2) = 

3(3) = 

3(4) = 

THE B MATRIX (DISTRIBUTION MATRIX) 

0.0 
0 . 0 
0 . 0 

1 . 00E + 00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

ENTER THE ELEMENTS OF THE OUTPUT MATRIX — C. 

C(1,1) = 

C (1,2) = 

C(1,3) = 

C (1,4) = 

C (2, 1) = 

C (2,2) = 

C(2,3) = 

C (2,4) = 



R 



THE C 

1 . 
0. 

DO YOU 



MATRIX (OUTPUT MATRIX) 

COE + 00 0. 0 0. 0 0.0 

0 1.00E+00 0.0 0.0 

WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



ENTER THE DESIRED FEEDBACK COEFFICIENTS. 
FDBK COEF? (1) = 



32 



13 



FDBK COEFF (2) = 



-6 



FDBK COEFF (3) = 



-3. 



FDBK COEFF (4) = 



THE DESIRED FEEDBACK COEFFICIENTS 



n 



2. CQE + Q1 
1 . 30E + 01 
-6. C0E + 00 
-3. 00E + 00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

THE OBSERVER EIGENVALUES (F MATRIX) CAN BE SUPPLIED 
EITHER IN THE FORM OF A CHARACTERISTIC POLYNOMIAL OR IN 
THE ROOTS OF THAT POLYNOMIAL. 

ENTER EITHER A P FOP POLYNOMIAL COEFFICIENT FORM 



OR AN 


F FOR FACTORED 


ROOT 


FORM. 




ENTER 

5 


THE 


REAL PART 


OF 


THE 


ROOT. 




ENTER 


T HE 


MAGNITUDE 


OF 


THE 


IMAGINARY 


ROOT 


ENTER 


T HE 


REAL PART 


OF 


THE 


ROOT. 




ENTER 


T HE 


MAGNITUDE 


OF 


THE 


IMAGINARY 


ROOT 


OBS ERVER 


EIGENVALUES 




REAL PAR 
-3.50E+0 



-4. 

0 



-4.00E+00 0.0 

THE OBSERVER CHARACTERISTIC POLYNOMIAL 
COEFFICIENTS IN ASCENDING POWERS OF S 
1.40E+01 7.50E+00 1.00E+00 

********************* ********** ********************* ** * *** 

THE F MATRIX (OBSERVER EIGENVALUE MATRIX) 

-7. 50E + 00 1. 0 0E+00 

-1.40E + 01 0.0 

THE G 1 MATRIX (OBSERVER GAIN MATRIX) 

3.55E + 01 2.92E+01 



0 . 0 



THE G 2 MATRIX (OBSERVER GAIN MATRIX) 
-3 . 00E + 00 



0 . 0 

G 2 > 

■3. 0( 

-1 . 50E + 00 



OUTPUT FEEDBACK COEFFICIENTS 
2. G0E + 01 8. 5 0E + 00 



COMPENSATOR FEEDBACK COEFFICIENTS 
1 . C0E + 00 0. 0 



THIS CONCLUDES THE LUENBERGS R OBSERVER DESIGN PROGRAM 
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DO YOU WANT TO RUN THE PROGRAM AGAIN? 
n 

ANALYSIS IS COMPLETE. DO YOJ WANT TO RON LINCON AGAIN? 
n 

LINCON IS NOW TERM INAT ED. 

The results of STV AR, 03SCON and LOSN are shown in 
Appendix I. From these the the observer is given as 



_ r -7.5 1 .0 1 r y 3 ( t) 1 r 85. 5 29. 25 1 r x, (t) 1 

Y< } ~ -14.0 0.0 y a (t) + 0.3 0.0 x, (t) 

L J L * J L J L * J 



-3.0 

+ u(t) 

-1.5 

L J 



and 



r X (M 1 

u(t) = 1 . 0 {r ( t ) - [20 .0 3.5 ] ' " - [1.0 

(t) 

L * J 



r y (t ) 1 
0 . 0 ] 3 ,. 1 
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G. OPTIMAL CONTROL PROGRAM (OPTCON) 



Given the linear, time-invariant system represented as 



where 

x = state vector 

Q = measurement noise covariance matrix (n x r.) 

N = number cf time intervals over which the sum is made 
R = random input (a scalari 
A = plant matrix (n x n) 

8 = distribution matrix (n x 1) 

and 

u (t) = control (a scalar). 

The output of the program is the feedback gain matrix 
which, when multiplied by the state vector, yields a scalar 
control. The following recursive equations were derived 
using dynamic programming, starting at the terminal time and 
working backwards. 



X (t) = Ax (t) 4- Bu (t) 



(4. G-1) 



OPTCON will minimize the cost function 

W-l 




(4. G-2) 
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0 



(4. G-4) 



^(k) = f + 4& T (k) , ^(3) = 

A T (k) = -C4P(k- 1)|]/:^ T P (k-1) A f R], A T (0) = 0 



(4. G-4) 



For simplicity in programming, 
defined: 

terminal = y/2x (N ) Qx( N) 

'M, 

trajectory = 1/2 \ x(<) 2x(k) 
fuel = 1/2 Ru2 (k) 



the following terms are 



k-O 



1, Te r n ina 1 Session Example 



Given the system and parameters described below find 
the discrete steady state gains for a sample of 0.1. 



r 0.0 1.3 1 



r o . o 1 



x(t) = „ A A x(t) + ^ A u(t) 

1.0 0. 0 1.0 

L J L J 



Q = 



1.0 1.0 

1.0 1.0 



R = 1.0 



In addition, run the program for a time interval of 



40. 

lincon 

EXECUTION BEGINS... 
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LINCON CONSISTS OF THE FOLLOWING SUBPROGRAMS: 

BASIC MATRIX MANIPULATION - <BASMAT> 

RATIONAL TIME RESPONSE - <RTRESP> 

STATE VARIABLE FEEDBACK - <3TVAR> 

CONTROLLABILITY AND OBSERVABILITY - <OBSCON> 

LUENBERGER OBSERVER - <LUEN> 

OPTIMAL CONTROL/KALMAN FILT3RS - <RICATI> 

DISCRETE TIME KALMAN FILTER - <KALMAN> 

OPTIMAL CONTROL - <OPTCON> 

PARTIAL FRACTION EXPANSION - <PRFEXP> 

ROOTS OF A POLYNOMIAL - <RODTS> 

TO USE ONE OF THE SUBPROGRAMS ENTER THE NAME BETWEEN THE 

SYMBOLS < >. 

optcon 

OPTCON MINIMIZES THE THE FOLLOWING COST FUNCTION: 

J (N) =MIN (SUM (X ( N) T*Q*X (N| +UT (N-1) *R*U (N-1) ) ) 

THE OUTPUT OF THE PROGRAM IS THE FEEDBACK GAIN MATRIX, 
A TRANSPOSE. WHICH WHEN MULTIPLIED BY THE STATS VECTOR 
YIELDS A SCALAR CONTROL. 

THE FOLLOWING RECURSIVE EQUATIONS WERE DERIVED USING 
DYNAMIC PROGRAMMING, STARTING AT THE TERMINAL TIME AND 
WORKING BACKWARDS: 

(1) AT (K) =- (DELT*P(K-1) *?HI/ (DELT*? (K-1) *DEL+R 

AT (0) =0 

(2) PSI(K) = PHI + DEL*AT(K) PSI (0) 

(3) P(K) =PSIT(K)*P(K-1> *PSI (K) +Q+R* A (K) *AT (K^ 

FI PS T ENTER THE PROBLEM IDENTIFICATION 

(* NOT TO EXCEED 20 CHARACTERS*) . thesis example 

ENTER THE NUMBER OF TIME INTERVALS (NSTAGE) OVER WHICH 
THE SUM IS TO BE MADE. 

*** NSTAGE MUST BE ENTERED IN 13 FORMAT *** 

*** ( I. E . , RIGHT JUSTIFY TO THREE DIGITS *** 

040 

ENTER THE ORDER OF THE SYSTEM (UP TO 8). 

*** ENTER IN II FORMAT *** 

2 

ENTER THE ELEMENTS OF THE 0 MATRIX. 

*** ALL MATRICES ARE ENTERED IN F-FORMAT *** 

*** I.E., PUT A DECIMAL POINT AFTER YOUR NUMBER * ** 

Q dr 1) = 



. Q 0 r 2) = 

0 

_ Q(2,1) = 

0 

^ Q (2, 2) = 



THE Q MATRIX 
1.00E+0 0 0.0 

0.0 2.00E+00 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 



ENTER THE VALUE OF THE SCALAR R 
R = 
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ENTER THE SAMPLE I NTERV AL--DT. 

*** ENTER DT IN F-FORMAT *** 

. 1 

AT THIS POINT YOU MUST CHOOSE ONE OF THE FOLLOWING OPTIONS 
OPTION A: ENTER THE NUMBER 0 IF 

(1) R IS FINITE, COST=TERMINAL+TRAJECTORY+FUEL, 

OR IF 

(2) R IS ZERO, COST=TESMINAL+TRAJECTORY+ 0 

OPTION B: ENTER THE NUMBER 1 IF 

(1) R IS FINITE, COST = TERMINAL+ 0 + FUEL, 

OR IF 

(2) R IS ZERO, CO ST=TER MI NAL + 0 + 0 

IF YOU WANT TO READ IN THE A AND 3 MATRICES, 

BUT NOT THE PHI AND DEL MATRICES, ENTER A 0 

HOWEVER, IF YOU rf A NT TO ENTER THE PHI AND DEL MATRICES, 
BUT NOT THE A AND B MATRICES, ENTER A 1. 

ENTER THE ELEMENTS OF THE PLANT MATRIX-- A . 

„ A (1, D = 



A (1,2) = 



A (2, 1) = 



o A(2 ' 2) = 

THE A MATRIX (PLANT MATRIX) 

0.0 1.00E+00 

1.00E+0 0 0.0 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

n 

ENTER THE ELEMENTS OF THE DISTRIBUTION MATRIX — B. 

o 

. 5(2,1) = 



THE B MATRIX (DISTRIBUTION MATRIX) 

0.0 

1. 00E+0 0 

DO YOU WANT TO CHANGE ANY ELEMENT OF THE MATRIX? 

r. 



THE PHI MATRIX 

1 . 00 50 03 E+00 

1.00 16672-01 

THE DSL MATRIX 
5.00416 US-0 3 

1.00 1667E-01 



1.0016572-01 
1.00 5003 E+00 



MINIMIZATION OVER ALL STAGES 
U ( 1) = AT (J) *X (J) 

AT (1 ) = -2.46E-02 

AT (2) = - 1.983-01 
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iKfcSStf' 


AT 


(21 = 


-3.91E-01 


UJ 

AT 


3) = 

m = 




AT 


(2) = 


-5.79E-01 


U ( 
AT i 


4) = 

fl) = 




AT 


(2) = 


-7.58E-31 


U( 
AT i 


5) = 

(1) = 


iimsyr 


AT 


(2) = 


-9.29E-31 


UJ 
AT i 


6) = 
(1) = 




AT 1 


(2) = 


- 1 . 09E+30 


UJ 
AT i 


7) = 

(1) = 




AT l 


(2) = 


-1 . 24E+33 


U ( 
AT l 


8) = 
fl) = 




AT i 


(2) = 


-1 .38E+30 


UJ 
AT i 


9) = 

(1) = 


AT (J)*Xf J) 
-9. 12E-31 


AT i 


(2) = 


-1.50E+03 


UJ 
AT i 


10) = 
(1) = 




AT l 


hi = 


- 1.612+33 


UJ 
AT i 


1 1) = 
nr * 




AT l 


(2) = 


-1.72E+03 


UJ 
AT l 


12) = 
M) = 


wwiiii' 


AT i 


(2) = 


- 1 .812+33 


UJ 
AT 1 


13) = 

[1) = 


AT (J) *XfJ) 
-1 .41 E+33 


AT i 


(2) = 


- 1 .89E + 33 


UJ 
AT ( 


14) = 

fl) = 




AT | 


[2J = 


- 1 . 96E + 0 3 


14, 


15) = 

l 1 ) * 


AT (J) *X(J) 
- 1 .60E+33 


AT 1 


[2\ = 


-2. 02E+03 


A if 1 


16) = 
[1) = 


AT (J) * X ( J ) 
- 1 .63E + 00 


AT l 


[2) = 


-2.072+33 


UJ 
AT i 


17) = 

fl) = 


AT (Ji^XiJ) 
-1 .7 oE+j3 


AT i 


|2) = 


-2. 122 + 33 


UJ 
AT i 


18) = 
l 1 ) = 




AT I 


2 = 


-2.162+33 



0 ( 19) = 

AT (1) = 


AT (J) *X(J) 
-1 .88E+30 


AT (2) = 


-2.20E+33 


UJ 20) = 

AT (1) = 




AT (2) = 


-2.233+03 


UJ 2D = 
AT (1 ) = 




AT (2) = 


-2.25S+00 


0 ( 22) = 
AT (1) = 




AT (2) = 


-2.27E+00 


UJ 23) = 

AT (1) = 


AT (J) *X(J) 
-2.04E+00 


AT (2 = 


-2. 29E+3D 


H^-s. 

—N 

II 

II 




AT (2) = 


-2.31E+33 


UJ 25) = 

AT (1) = 




AT (2) = 


-2.32E+33 


UJ 26) = 

AT (1 ) = 




AT (2) = 


-2. 343 + 33 


UJ 27) = 

AT ( 1 ) = 


AT (J)*XIJ) 
-2. 13E+03 


AT (2) = 


-2.35E+30 


UJ 28) = 

AT(1) = 




AT *2) = 


-2.35E+30 


UJ 29) = 

AT(1) = 




AT (2) = 


-2 .36E + 33 


UJ 30) = 

AT(1) = 




AT (2) = 


-2.37E+33 


UJ 31 ) = 

AT(1) = 




AT (2) = 


-2.37E+33 


UJ 3 2) = 

ATM) = 




AT (2) = 


-2.38E+33 


UJ 33) = 

AT (1) = 


AT (J) *XfJ ) 
-2.20E+33 


AT (2) = 


-2.38E+33 


UJ 34) = 

ATM) = 


AT (J) * X ( J ) 
- 2 . 20E + J 3 ’ 


AT (2) = 


-2. 39E+33 


UJ 35) = 

AT ( 1 ) = 


AT (J) *X (3) 
-2.21E+33 


AT (2 = 


-2.39E+33 



n 



AT (2) = - 2 . 39E+30 

U ( 37) = AT (J)*X(J) 

AT(1) = -2.22E+0O 

AT (2) = -2.39E+0D 

U ( 38) = AT (J1*X(J ) 

AT ( 1 ) = -2.22E+30 

AT (2) = -2.40E+00 

D ( 39) = AT (J) *X(J ) 

AT (1 ) = -2 . 22E + JD 

AT (2 ----- 



! -- 



-2. 40E+00 



U ( 40) = AT (J) *X( J) 

AT (1) « -2.23E+30 

AT (2) = -2.40E+00 



THIS CONCLUDES THE OPTIMAL CONTROL PR33RAM 
DO YOU WANT TO RUN THE PROS R A M AGAIN? n 



ANALYSIS IS COMPLETE. DO YOU 
LINCON IS NOW TERMINATED. 



WANT TO RUN 



(OPTCON) . 
LINCON AS AIN? 



The results, 
steady state gains are 



shown in Appendix J, indicate rhat 
achieved at about -2.23 and -2.4. 
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V 



CONCLUSIONS AND RECOMM END ATIONS 



A. CONCLUSIONS 

Although LINCON was written primarily as a 

teaching/learning tool, it can still be quite useful to the 
practicing engineer for design and analysis problems. It was 
written in modular form so that it could be easily modified 
by the addition of subroutines. 

LINCON has been extensively tested in an advanced 
optimal estimation course. The interactive aspects proved 
highly successful. Hopefully all the "bugs'* have been 
eliminated . 

As stated earlier, althougn the original intent of this 
thesis was to adapt Desjardins* version of Melsa's LINCON by 
making it interactive, LINCON began to grow as other 
routines were added and/or extensively modified. 

OPTCON, the optimal control program using recursive 
equations derived from dynamic programming, is a new member 
to the LINCON family. Desjardins' KALMAN, the discrete time 
Kalman filter program, underwent considerable programming 
changes before achieving its present form. 
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B 



F. ECO MM END AT IONS 



(1) The source program, LINCON FORTRAN A1, must now be 
passed from user to user and than compile! before it can be 
used. As can be seen in the terminal session examples, the 
program was invoke! by typing "iincon". Actually, this is 
an executive program, LINCON EXEC A1, comprising of the 
following statements: 

FILED EF 09 PRINTER ( RECFM FA LRECL 133 BLOCK 133 
LOAD LINCON (START 

The first statement iefines 09 as the printer and permits it 
to print out 133 characters per line. The second statement 
invokes the compiled version of LINCON. It is recommended 
that LINCON be place! on a utility disk so that users may 
link to it instead of the currant procedure. 

(2) At times it can be exceedingly difficult to 
interpret the tabular output of some of the programs. It is 
recommended that a graphics package be developed for RTRESP, 
RICATI, KALMAN and OPT CON. The package should be interactive 
with the output being first displayed on the terminal screen 
and then allowing the user to choose the type of output, 
i.e., VERSATEC, TEKTRONIX or print-plot. 
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(3) In general, the programs are limited to eighth-order 
problems. If the need should arise to solve higher order 
systems, this limiiation may be removed by extending the 
appropriate dimension statements. The user must remember to 
alter the format statement pertaining to the output, either 
decreasing the significant figures or adding a "wrap-around" 
feature to overcome the printer limitations of 133 
characters per line. 

(4) As it is written, LUEN can only solve for a 
reduced-order observer. It is recommended that the program 
be modified so that the user has the option of selecting a 
reduced-order observer or an identity observer. 

(5) The ficticious and real c matrices of SIVAR are 
required to have the dimensions 1 x n. It is recommended 
that the program be modified to accept a dimension size of m 
x n. 
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APPENDIX A 



BASIC MATRIX PROGRAM 

PROBLEM IDENTIFICATION: THESIS EXAMPLE 

* ** ** ** ** * ******* * *** ********************************** *** 



THE A MATRIX 

1. 0 000 00E+00 0.0 

0.0 -2. 000303E+00 

0. 0 -5. 000000 E- 0 1 

THE DETERMINANT OF THE MATRIX 
-1.5 COO COE+OO 

THE INVERSE OF THE MATRIX 

1.0 00000 E +00 0.0 

0. 0 -6. 665555 E-01 

0. 0 -3. 333333E-01 



0.0 

1. 300000E+00 
1 . 0000 00E+ 00 



0.0 

6.556665 E-0 1 
1 .333333E+00 



********************************************************** 
THE MATRIX COEFFICIENTS OF THE NUMERATOR OF THE 
PHI ( S ) MATRIX 

THE MATRIX COEFFICIENT OF S**2 
1.0 OOO OOE+OO 0.0 

0.0 1. OOOOOOE+ 00 

0 . 0 0 . 0 



0.0 

0.0 

1. OOOOOOE+OO 



THE MATRIX COEFFICIENT OF S**1 
1. OOOOOOE+OO 0.0 
0.0 -2. OOOOOOE+OO 

0.0 -5. OOOOODS-OI 



0 3 

1*. OOOOOOE+OO 
1. OOOOOOE+OO 



THE MATRIX COEFFICIENT OF S**0 
- 1. 5 COO COE+OO 0.0 

0.0 1. OOOOOOE+OO 

0. 0 5. 000000 E-01 



0. 0 

•1. OOOOOOE+OO 
■2. OOOOOOE+OO 



******* ** * *********** **** ********************************* 
THE CHARACTERISTIC P OLYN D M I A L-IN ASCENDING POWERS OF S 
1.5 OOO 00E+00 -2. 500000E + 00 0.0 1 . OOOOOOE+OO 

********** ********** *************************************** 



THE EIGENVALUES OF THE A 1ATRIX 
REAL PART IMAGINARY PART 

8. 2 287 55S-0 1 0.0 

- 1. 822S76S+00 0.0 

1. 0 000 OOE+OO 0.0 

********** *********** ************************************* 



THE 



THE ELEMENTS OF 


THE 


MATRIX COEFFICENT 


OF 


0. 0 


o, 


0. 0 


-6 


0. 0 


- 1 



STATS TRANSITION MATRIX 
SXP( 8. 2 28755E-0 1 ) T 

0 0.0 

6943 1 7 E-02 3. 779633E-01 

3893 1 1 E- 0 1 1.056945E+00 



THE 



MATRIX COEFFICENT 
0. 0 
0. 0 
0. 0 



OF EX?( - 1 . 822875 E + OG) T 
0.0 0.0 
1 . 066944 E+ 00 -3. 77964 12-01 

1. 889820 E-01 -6. 694669E-02 



THE MATRIX COEFFICENT 
1. 0 OOOOOE+OO 
0 . 0 
0 . 0 



OF EXP ( 1. OOOOOOE+OO) T 

3.0 0.3 

-2. 2649 77 E- 06 2. 85 1023E-C6 

-5. 3644 1 8E- 07 1.072884E-06 
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APPENDIX B 



PARTIAL FRACTION EXPANSION 

PROBLEM IDENTIFICATION; THESIS EXAMPLE 

******* ********************4:********#*****#*****:**** *** *** 

THE INPUT FUNCTION 3 AIN 
7. 0 C00 00E+00 

********** *** * ****** ******************************** *** *** 
NUMERATOR COEFFICIENTS - IN ASCENDIN 3 POWERS OF S 

2. 0000E+00 2.00 00E+ 00 1.0000E+00 1.0000E+00 

NUMERATOR ROOTS ARE 

REAL PART IMAG. PART 

0.0 -1. 414213E+00 

0.0 1. 4 1421 3E + 00 

-1. 0 00 0 0 0E+0 0 0.0 

* 4c* ******************************************************* 

THE INPUT FUNCTION 3 AIN 
7. 0 COO 00E+00 

********************* ********************************** *** 



DENOMINATOR COEFFICIENTS - IN ASCENDING POWERS OF S 
2. 000E+00 1.000 E + 00 0. 0 3.000E + 00 1.000E+00 



DENOMINATOR ROOTS ARE 
REAL PART IMAG. PART 

-3. 0 18859E+00 0.0 

-9. 1 27 604 E- 01 0.0 

4.6 580 98E-0 1 -8. 30 84 2 7 E- 0 1 

4.6 58 098 E- 01 8. 308427E-01 



MULTIPLICITY 

1 

1 

1 

1 



**************************************************** *** *** 



RESIDUE MATRIX - REAL PART 
5. 8 10872E+00 

3. 1 70837E-01 

4. 36023 IE-01 
4. 36023 IE-01 

RESIDUE MATRIX - IMAG. PART 
- 2. 0 503 4 9E-0 7 
0 . 0 

2. 0 614 06 E+0 0 
-2. 0614 06E+00 

* ** ** *********************************************** *** *** 
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APPENDIX C 



ROOTS OF A POLY N OMIAL 

PROBLEM IDENTIFICATION: THESIS EXAMPLE 

********** *********** ********************************** **** 



POLYNOMIAL COEFFICIENTS - IN ASCENDING POWERS OF S 
8. 0 000E-01 5. 10 00E + 00 3.0000E+00 1.0000E+00 

THE ROOTS ARE REAL PART IMAGINARY PART 

-1. 413221E+00 1.61 6248E + 0 0 

-1. 4 13221E+00 -1.61 6248E+0 0 

-1.7355643-01 0.0 

********************************************************** 
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APPENDIX D 



RATIONAL TIME RESPONSE 

PROBLEM IDENTIFICATION: THESIS EXAMPLE 

******* *** ******* * ** * ********** ****** ** ***** *********** *** 

THE A MATRIX (PLANT MATRIX) 

1.0 COO OOE+OO 0.0 
0.0 -2. OOOOOOE+OO 

0.0 -5. OOOOOOE-OI 



0 . 0 

1. 000000E+00 

1 .ooooooe+oo 



THE B MATRIX (CONTROL VECTOR) 
0 . 0 
0 . 0 

1 . 0 00 0 OOE+OO 



THE C MATRIX (OUTPUT 
1. 0 00 0 OOE+OO 
4 . 0 000 OOE-O 1 

1.0 COO OOE+OO 



VECTOR) 



THE FEEDBACK COEFFICIENT 
1. 0 COO OOE+OO 
1. 0 00 0 0 0E+00 
0 . 0 



VECTOR 



THE C CNT ROLLER 3 AIN 
3. 2 COO OOE+OO 

********************************************************** 
INITIAL CONDITIONS VECTOR-X(O) 

0. 0 

0 . 0 * 

0.0 



THE INPUT FUNCTION 3 AIN 
5. 0 000 OOE-O 1 

NUMERATOR POLYNOMIAL OF R ( S) -ASCENDING POWERS OF S 
1. 0 00000E+00 1. OOOOOOS + OO 



NUMERATOR ROOTS ARE 

REAL PART IMAG. PART 

-1. 0000 00E+00 0.0 

DENOMINATOR POLYNOMIAL OF R (S) - ASCENDING POWERS OF S 

-2. OOOOOQE+OO 0. 0 1.030000E+00 

DENOMINATOR ROOTS ARE 

REAL PART IMAG. PART 

1. 4 142 1 3E+00 0.0 

-1.4 14213E+00 0.0 

# 3}c *#:$::$: * $£ *:$£**:*:$:*££ ISC*##;**:****:*#**;*:*:**;**:*;***:********:** 

THE TIME RESPONSE OF THE STATE X (T) 

VECTOR COEFFICIENT OF EX P ( -5 . 00 S-0 1 ) T *COS ( 1 . 2 0 E + 0 0 ) T 
0. 0 -3. 695463 3-01 -9 . 7 1 76 97 S-0 1 

VECTOR COEFFICIENT OF EX ? ( - 5 . 00E- 0 1 ) I* SIN( 1 . 2 0E + 00 ) T 
0.0 -3. 465749E-01 -7. 53 2007E-02 



THE VECTOR COEFFICIENT OF EXP ( 

0.0 0.0 

THE VECTOR COEFFICIENT OF SX?( 
0. 0 2. 670373 S-0 T 

THE VECTOR COEFFICIENT OF EXP ( 
0. 0 1. 025083 S-OT 



1. OOOOOOS+OO) 7 
2. 582209S-06 

1.4 1 421 3S+00) T 
9. 1 17225E-01 

- 1. 41 42132 + 00) T 
6.00486 4 S-02 



******************************************************** 



* 
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THE TIME RESPONSE OF THE OUTPUT YjT) 

THE COEFFICIENT OF EX P (-5 . 0 0 OOE-O 1) I* CO S ( 1 . 2 04 1 E + 0 0) T 
-1. 1 19588E+00 



THE COEFFICIENT OF EXP ( 

- 2. 1 369 OOE-O 1 

THE COEFFICIENT OF EXP( 
2. 6 82209E-06 

THE COEFFICIENT OF EXP< 
1. 0 18537E+00 

THE COEFFICIENT OF EXP ( 
1.0 105 2 IE-01 

********************* ******** 



5. 9 0 00E-01) T*SIN(1.2041E+00) T 

1 .000000E+00) T 

1.41421 3E+00) T 

-1.41421 3E+00) T 
************************* *** 
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APPENDIX 



OBSERVABILITY, CONTROLLABILITY 
PROBLEM IDENTIFI CATION: THESIS EXAMPLE 

*** ** ** *** ********** * ********** ************ ********* *** *** 
THE A MATRIX (PLANT MATRIX) 

0.0 1.000000E+00 0.0 

- 1.000000E+00 -5. 0000 00E-01 1.000000E + 00 

0.0 0.0 1 . 000000E+00 



THE B MATRIX 
2. OOOOOOE+OO 
0.0 
0.0 



1. 0000 OOE+OO 
1. 0000 OOE+OO 
0 . 0 



THE C MATRIX 

0.0 

1.0000 0 0E+ 0 0 
-2. 00000 0E+00 



1. 0000 OOE+OO 
1 . 0000 OOE+OO 
1. 0000 GOE + OO 



0.0 

0.0 

0.0 



********************************************************** 



OBSERVABILITY INDEX = 2 

THE SYSTEM (A , B) IS UNCONTROLLABLE 
********************* **** ********************************* 
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APPENDIX F 



OPTIMAL CONTROL/CONTINUOUS KALMAN FILTER PROGRAM 
PROBLEM IDENTIFICATION: THESIS EXAMPLE 

******************** ********************************** 4=*** 



THE A MATRIX 
■ 1 .0000 0 0E+ 0 0 
0. 0 



THE B MATRIX 
1 . 00 00 0 0E + 0 0 
0.0 



THE C MATRIX 
1.00 0000E+00 
0.0 



(PLANT MATRIX) 

0.0 

-2. 0000 OOE+OO 

(DISTRIBUTION MATRIX) 

0 . 0 

1 . 0000 OOE+OO 

(MEASUREMENT MATRIX) 

0 . 0 

2. 0000 OOE+OO 



5$C * * * 3$e ^e###**#*##*#* *3$e:$e3$ejfc3fc:$c* $$ $c * 



THE R MATRIX 
1 . 0000 0 0E+ 0 0 
0 . 0 



THE Q MATRIX 
1.000000E+00 
1 .00000 CE+OO 



(CONTROL WEIGHTING MATRIX) 

0 . 0 

2. OOOO OOE + OO 

(STATE WEIGHTING MATRIX) 

1. OOOO OOE+OO 
1. OOOO OOE + OO 



*$$*** *********** **** * 
*** CONTROL OPTION *** 



**** c** **************** 



THE P MATRIX (TERMINAL BOUNDARY VALUE MATRIX) 

0.0 0.0 

0.0 0.0 

TRANSIENT SOLUTION 
TIME = 1 . OOOE+O 1 

GAINS 

0.0 0.0 

0.0 0.0 



TIME = 9.000E+00 

GAINS 

3. 74 515 OE -01 2. 808074E-01 

1 . 40 40 3 7E- 0 1 1. 1127 29E-01 

TIME = 8. OOOE+OO 

GAINS 

3. 98279 7E- 0 1 2. 8497 1 1E-01 

1.424856E-01 1.117260E-01 

TIME = 7. OOOE+OO 

GAINS 

3.99705 8E- 0 1 2. 8479 93E-01 

1. 423996E-01 1. 1 173 71E-01 

TIME = 6. OOOE+OO 

GAINS 

3. 99795 9E- 0 1 2. 847759E-01 

1 . 4238 7 9E- 0 1 1 . 1 173 99E-01 

TIME = 5. OOOE+OO 

GAINS 

3. 99799 9E- 0 1 2. 847756E-01 

1.423877E-01 1 . 1173 99 2-01 



TIME = 4. OOOE+OO 

GAINS 

3. 99799 9E- 0 1 2. 847756E-01 

1.423877E-01 1.117399E-91 
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TIME = 3 . OOOE+OO 

GAINS 

3. 9979 9 9E- 0 1 2.847756E-01 

1.423877E-01 1.117399E-01 

TIME = 2 . OOOE+OO 

GAINS 

3. 99799 9E- 0 1 2. 847756E-01 

1.423877E-01 1.117399E-01 

TIME = 1 . OOOE+OO 

GAINS 

3. 99799 9E- 0 1 2. 847756E-01 

1.423877E-01 1.117399E-01 

TIME = 2 . 861 E-3 5 

GAINS 

3. 9979 9 9E- 0 1 2. 847756E-01 

1.423877E-01 1.117399E-01 

* ** **** *************************************************** 

****** *********** **** 

*** FILTER option *** 

********************* 

THE P MATRIX (INITIAL BOUNDARY VALUE MATRIX) 

0.0 0.0 

0.0 0.0 

********************************************************** 
TRANSIENT SOLUTION 

TIME = 0.0 

GAINS 

0.0 0.0 

0.0 0.0 

TIME = 5 . OOOE-O 1 

GAINS 

2.393162E-01 2.004539E-01 

8. 01815 7E - 01 5 . 8495 94E-01 

TIME = 1. OOOE+OO 

GAINS 

2. 70831 7E-01 2. 127941E-01 

8. 51 176 7E-0 1 7. 053521E-01 

TIME = 1 . 500E+00 

GA IN S 

2. 7684 8 8E-0 1 2. 133131E-01 

8. 5327 2 4E- 0 1 7. 055743E-01 

TIME = 2.COOE+00 

GAINS 

2. 73471 5E -0 1 2. 132589E-01 

8 . 5303 5 4E- 0 1 7. 055343E-01 

TIME = 2. 500E+00 

GAINS 

2.7896 8 8E- 0 1 2. 13221 1E-01 

8.52 884 3E- 0 1 7. 055938E-01 

TIMS = 3. OOOE+OO 

GAINS 

2 . 79 1 2 7 IE- 0 1 2. 1320 74E-01 

8 . 52 32 9 7E- 0 1 7. 055972S-01 



TIME = 3 . 500E+00 

GAINS 

2.79 178 IE-01 2. 1320 2 7 E- 01 

3.52 81 0 9E- 0 1 7.055984E-01 
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TIME = 4 . OOOE + O 3 

GAINS 

2.79193 8E-01 2. 132020E-01 

8. 52807 8E- 01 7. 055986E-01 

TIME = 4 . 500E+33 

GAINS 

2.79198 3E- 0 1 2. 132018E-01 

8. 52 80 7 0E- 0 1 7. 055986E-01 

TIME = 5 . OOOE + 3 0 

GAINS 

2. 791983E-01 2. 13231 8E-01 

8. 52 80 7 OE- 0 1 7. 055986E-01 
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APPENDIX G 



DISCRETE TIME KALMAN FILTER PROGRAM 
PROBLEM IDENTIFICATION: THESIS EXAMPLE 

# ## * # 4c# #*# #*# # #### ## # ## ####*##### #### #####* ########*#*# ### 



THE P 
1. 00000 
0 . 0 

THE G 
1. 25000 
5. 00000 

THE W 
PERIU 
4. 00000 

THE H 
1.00000 
*#*#*#***# 
THE R 

5. 00 00 0 

THE P 

1.00000 
0 . 0 

### *##### # 



HI MATRIX (TRANSITION MATRIX) 

GE+00 5. 0000 00E-01 

1. 0000 OOE+OO 

AMMA MATRIX (DISTRIBOTION MATRIX) 

0E-01 

0E-01 

MATRIX (MEAN-SQUARE MAGNITUDE OF THE 
RBATION ACCELERATION MATRIX) 

0E+0 0 

MATRIX (OBSERVATION MATRIX) 

CE+00 0.0 

********##**#**##*#**##***##*#*##*#*##*#**#*#**# 
MATRIX (MEASUREMENT NOISE COVARIANCE MATRIX) 

0E+0 0 

MATRIX (INITIAL CONDITION MATRIX) 

0E+03 0.0 

1. 0000 00Ef03 

*********** ********** *************************** 



9 . 

9. 

3. 
7. 
6 . 
5. 
5. 

4. 
4. 

4 . 



K = 0 



GAINS 

95024 8E-01 


0. 0 


K = 1 

GAINS 

8077 2 3E- 0 1 


1. 9237 59E+ 00 


K = 2 

GAINS 

2902 9 9E- 0 1 


9. 98075 IE-01 


K = 3 

GAINS 

02 82 0 7E-0 1 


5. 2372 27E-01 


K = 4 

GAINS 

13471 9E-0 1 


4. 522047E-01 


K = 5 

GAINS 

54369 9E-0 1 


3. 7160 1 6E-0 1 


K = 6 

GAINS 

18499 1E-0 1 


3. 3625 13E-01 


K = 7 

GAINS 

99227 8E-01 


3. 2323 93E-01 


K = 8 

GAINS 

90446 8E-0 1 


3. 201340E-01 


K = 9 

GAINS 

87 25 4 9E- 0 1 


3. 2023 26E-01 
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K = 10 

GAINS 

4. 8644 0 0E-01 

K = 11 

GAINS 

4. 8634 7 5E-0 1 

K = 12 

GAINS 

4. 863456E- 01 

K = 13 

GAINS 

4. 86294 4E-01 

K = 14 

GAINS 

4. 86216 8E-01 

K = 15 

GAINS 

4. 86 1480E-01 

K = 16 

GAINS 

4. 86 103 5E-01 

K = 17 

GAINS 

4. 8609 06E-0 1 

K = 18 

GAINS 

4. 86071 2E-01 

K = 19 

GAINS 

4. 86 068 5E-01 



K = 20 

GAINS 

4. 86 06 8 0E- 01 



3. 2079 18E-01 
3. 2103 92E-01 
3. 2099 99E-01 
3. 20 35 5 3 E- 01 
3. 2072 75E-01 
3. 2064 94E-01 
3. 2061 43S-01 
3. 2060 35E-01 
3. 206024S-01 
3. 206034E-01 
3. 20604 IE-01 



♦ ******#*:$(****:* fc**:*********#**^*****#*#****:***:!!****# ****** 
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APPENDIX H 



STATE VARIABLE FEEDBACK PROGRAM 
PROBLEM IDENTIFICATION: THESIS EXAMPLE 

** ** ** ** * ** ^ * ** * ********** ************************ 

THE A MATRIX (PLANT MATRIX) 

-1. 0 C0000E+00 1. 000003E+00 0.3 

0. 0 0. 0 1 . 0000 00E+ 00 

0. 0 -3. 000003 E + 00 0.3 

THE 3 MATRIX (CONTROL MATRIX) 

0.0 
0. 0 

1. 0 000 OOE+OO 

* ** ** *# ** * *** ******** ** ** ********************************* 
nppM-TOOP CAinr ATTON'n 

DENOMINATOR COEFFICIENTS - IN ASCENDING POWERS OF S 

3. 0 OOOE + OO 3.0300E+03 1.0000E+00 1.0003E+00 

THE ROOTS ARE REAL PART IMAGINARY PART 

3. 3 - 1. 732051E + 00 

0.3 1. 732051 E+00 

-1. 300000E+00 0.0 

********************************************************* 
THE C MATRIX (FICTICIOUS OUTPUT VECTOR) 

0. 0 
0.0 

1. 0 COO OOE+OO 

NUMERATOR COEFFICIENTS - IN ASCENDING POWERS OF S 

0. 0 1. 000303 E + 00 1.000000E + 00 

THE ROOTS ARE REAL PART IMAGINARY PART 

-1. 300000E+00 0.0 

3.0 0.0 

********************* **** ****** ************************ *** 
THE C MATRIX (OUTPUT VECTOR) 

1. 0 COO OOE+OO 

1. 0 COO OOE+OO 
0. 0 

NUMERATOR COEFFICIENTS - IN ASCENDING POWERS OF S 

2. 0 00Q00E+00 1 . 000003 E + 00 

THE ROOTS ARE REAL PART IMAGINARY PART 

-2. 330000E+00 0.0 

***** ** ** * *********** **** ******************* ******** *** *** 
CLOSED-LOOP CALCULATIONS 

^ Y = p ## £ # £ 

THE NUMERATOR OF H-EQUIVALENT - 
IN ASCENDING POWERS OF 5 

5. 0 00C 00E-3 1 1 . 500000 E + 00 1.500000E + 00 

THE ROOTS ARE REAL PART IMAG. PART 

-5. 300000E-01 -2. 836756S-0 1 

-5.3 300003-0 1 2. 886756E-0 1 

THE FEEDBACK COEFFICIENTS 

5. 0 00 000 E- 01 0. 0 1. 500000S+00 

THE GAIN = 2. 0003 OOE + OO 



THE CLOSED-LOOP CHARACTERISTIC POLYNOMIAL - 
IN ASCENDING POWERS OF 3 

4. 0 00 0E + 00 6. 00 OOE + 33 4.0000E + 00 1. 00003 + 00 
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THE HOOTS ARE 



REAL PARI IMAG. PART 
-2.3 Q000QE+00 0 

-1. 300000E+00 -1 

-1. OOOOOOE+OO 1 

MAXIMUM NORMALISED ERROR = 0.0 



0 

000000E+0 0 
000000E+0 0 
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APPENDIX I 



STATE VARIABLE FEEDBACK PROGRAM 

PROBLEM IDENTIFICATION: THESIS EXAMPLE 

****************************************:************:*#**** 



THE A MATRIX (PL ANT MATRIX) 

0. 0 1 . 00000 0E+00 3.0 

0.0 0.0 1 . OOOOOOE+QO 

0.0 0.0 0.0 

0. 0 -1.5000 002+01 -2. 300000E+01 

THE B MATRIX (CONTROL MATRIX) 

0. 0 
0.0 
0. 0 

1. 0 00 0 0 0E+00 



0.0 
0. 0 

1. 000000E+00 
- 9 . 000000 E+00 



* ** **** ************ **** ***************** * * * ** * * ** * ** * *** 



npFtj- innp rarrnr 

DENOMINATOR COEFFICIENTS - IN ASCENDING POWERS OF S 
0. 0 1.5002*0 1 2 . 303E + 01 9. OOOE+OO 1. OOOE+OO 

THE ROOTS ARE REAL PART IMAGINARY PART 

-3. 3 000002+00 0.0 

-4.9 99999E + 00 0.0 

-9. 999999E-0 1 0.0 

0.3 0.0 

*** ********************************************** ********** 

THE C MATRIX OUTPUT VECTOR) 

2. OOOOOOE+OT 
1. 000000E+01 
0. 0 
0. 0 

NUMERATOR COEFFICIENTS - IN ASCENDING POWERS OF S 
2. OOOOOOE+OI 1 . 000003 E + 01 

THE ROOTS ARE REAL PART IMAGINARY PART 

-2. 300000E+00 0.0 

* ## 4c4c4=4c 4«4c 4c 4c4«4c ***** 4e4c 4c 4c4c 4=4c 4c 4c 4c 4e 4c 4c 4c4:4e4c4c4c4c4c4e4c4c 4c 4c4c4c4c4c4c4c4e 4<4c4e 4 : 4«4e 



CLOSED-LOO? CALCULATIONS 
KEY = P ***** 

THE NUMERATOR OF H-EQUIV AL ENT-IN ASCENDING POWERS OF S 
2.000E+01 1.303E+01 -6.000E+33 -3.000E+00 

THE ROOTS ARE REAL PART IMAG. PART 

-1. 039623E+00 3.0 

3.206289E+00 0.0 



THE FEEDBACK COEFFICIENTS 
2. 0 00E + 01 1.300E+01 



-6. OOOE+OO 



-3. 000E+00 



THE GAIN = 



1. 0003 00E+03 



THE CLOSED-LOOP CH AR ACTER I S T IC POLYNOMIAL 
IN ASCENDING POWERS 0? S 
300E+01 2.800E+01 1. 7032+01 6. OOOE+OO 

THE ROOTS ARE 



1 .OOOE+OO 



REAL PART IMAG. PART 

-1 . 300000E+00 -2. 030000E+30 

-1 . 3000002 + 00 2. 000000E + 0 3 

-2. 3 004842 + 00 0.0 

-1.9395162+00 0.0 

MAXIMUM NORMALIZED ERROR = 0.0 



OBSERVABILITY, CONTROLLABILITY 

PROBLEM IDENTIFICATION: THESIS EXAMPLE 



138 



********** *********** ************************************* 
THE A MATRIX (PLANT MATRIX) 

0.0 1.0Q03 00E+00 0.0 

0.0 0.0 1 . 000000E+00 

0 . 0 0.0 0.0 

0. 0 -1.5000 00E+01 -2. 300000E+01 



0.0 

0.0 

1.000000 E+00 
-9. 000000E+00 



THE B MATRIX 
0 . 0 
0 . 0 
0.0 

1. 00000CE+00 



1 



S81 



1 C MATRIX 
1 0 0 GE + 0 0 



0 . 0 0 . 0 0.0 

0.0 1 . ooooooe+oo 0.0 0.0 

OBSER VABILITY INDEX = 3 

THE SYSTEM (A .3) IS CONTROLLABLE 
***** **************** ************************************* 



LUENBER3ER OBSERVER DESIGN PROGRAM 
PROBLEM IDENTIFICATION: THESIS EXAMPLE 

********** *********** ************************************* 

THE A MATRIX (PLANT MATRIX) 



0. 0 


1.0000 00E+00 


0 . 0 


0.0 


0. 0 


0.3 


1 . 000000E+00 


0.0 


0. 0 


0.0 


0.0 


1 . 000000 E+00 


0.0 


-1.5000 00E+01 


-2. 300000E+0 1 


-9 . 000000 E+00 



THE B MATRIX (DISTRIBUTION MATRIX) 

0 . 0 
0.0 
0 . 0 

1. 0C00 00E+00 

THE C MATRIX (OUTPUT MATRIX) 

1.0 COO 00E+ 0 0 0. 0 0. 3 0.0 

0. 0 1.0000 00 E + 00 0. 0 0.0 

THE DESIRED FEEDBACK COEFFICIENTS 

2 . 0 00 0003+ 3 1 

1. 300000E+01 
-6. 0 COO 00 E+0 0 
-3. 0 COO 00E+00 

OBSERVER EIGENVALUES REAL PART IMAG. PART 

-3. 5000 00 E+00 0.0 

-4. 000000E+00 0.0 

OBSERVER CHARACTERISTIC POLYNOMIAL 
COEFFICIENTS IN ASCENDING POWERS OF S 

1. 4 COO 00E+0 1 7. 5000003 + 00 1.000000E+00 

THE F MATRIX (OBSERVER EIGENVALUE MATRIX) 

-7. 5 COO 00E+00 1 . 000300 E + 00 

-1. 4 OOOOOE+O 1 0.0 

THE 51 MATRIX (OBSERVER GAIN MATRIX) 

3. 5 499973+0 1 2.9249942+01 

0.0 0.0 

THE G 2 MATRIX (03SSRVER GAIN MATRIX) 

-2. 9999973+00 
-1. 5000 C1S+00 
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OUTPUT FEEDBACK COEFFICIENTS 
2. 0 OOOOOE+O 1 8. 50000* 5 + 00 

COMPENSATOR FEEDBACK COEFFICIENTS 
1. 0 00 0 0 0E+0 0 0.0 
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APPENDIX J 



OPTIMAL CONTROL PROS RAM 

PROBLEM IDENTIFICATION: THESIS EXAMPLE 

********** *** ******* * ******** ******** ** **************** *** 



THE NUMBER OF TIME INTERVALS = 
THE ORDER OF THE SYSTEM = 2 



THE Q MATRIX 

1.0 



1 

0 . 0 



C0000E+00 



0 . 0 

2. OOOOOOE+OO 



40 



THE SCALAR R = 1. 

THE SAMPLE INTERVAL (DT> = 0.1000 

THE A MATRIX (PLANT MATRIX) 

0. 0 1 . 000000 E + 00 

1.0 COO 00E+0 0 0.0 

THE 3 MATRIX (DISTRIBUTION MATRIX) 

0 . 0 

1. 0 000 OOE+OO 

THE PHI MATRIX 
1. 0050 03E+30 
1. 0 01667E-01 

THE DEL MATRIX 
5. 0 04 164 E- 03 
1. 001667E-01 



1. 001667E-01 
1. 005003E+00 



MINIMIZATION OVER ALL STAGES 



U ( 1 ) = 

At ( 1) ' = 
AT (2) = 



AT (J) *X [ J) 
-2.463-32 
-1.98 2-0 1 



Uf 2) = AT (J)*X f J) 
AT(1) = -7.72E-32 

AT (2) = -3.91 E- 0 1 

U( 3) = A T (J) *X ( J) 

AT(1) = -1.55E-31 

AT (2) = -5.79E-01 



U { 4) = AT (J) *X ( J) 

AT(1) = -2.54 E-J 1 

AT (2) = -7.58E-0 1 



U( 5) = 
At ( 1) = 




AT (2) = 


-9.29E-0 1 


U ( 6) = 

AT ( 1) = 




AT(2) = 


-1.09EO0 


U ( 7 ) = 

AT ( 1) = 




AT (2) = 


- 1.24EO 0 



U ( 8) = A T (J) *X( J) 

AT ( 1) = -7.742-0 1 

AT ( 2) = - 1.3824-00 



11 1 



U 

AT ' 
AT 



.?) = 



AT ( 1) = 

(2) = 



U( 10) = 

AT(1) = 

AT (2) = 

U( 11) = 

At ( 1) = 

AT ( 2) = 

U( 12) = 
ATM) = 
AT (2) = 

Ojf 13) = 
AT(1) = 

AT (2) = 

U( 14) = 

AT ( 1) = 

AT (2) = 

U( 15) = 
AT ( 1 ) = 

AT ( 2) = 

U( 16) = 
AT ( 1) = 

AT ( 2) = 

U j 17) = 
AT ( 1) = 

AT (2) = 

Ujf 18) = 

AT(1) = 

AT (2) = 

U( 19) = 
AT (1) = 

AT (2) = 

U( 20) = 

ATM) = 
AT ( 2 ) = 

U( 21) = 
A T ( 1) 

AT (2) 

U( 22) 

i&l 

AT (2) 

U( 24) 

AT (1) 

AT (2) 

U( 25) 
ATM) 

AT (2 



-1.50E+00 
-1.613+00 

iT.^SW 

- 1. 723+00 

AT (J) *Xf J) 

- 1 .30E+ j 0 
-1.81 3+0 0 

AT (J) *X ( J) 

- 1 . 4 1 E+ 0 0 
-1.893+00 

AT (J) *X < J) 
-1.51E+0O 

-1. 963+00 

-2.02E+0 0 

AT (J) *11 J) 

- 1.683* j 0 
-2.07E+00 

-2.12E+D0 

-2. 16E+0 0 

ST.'ftSW 

-2.203+00 
= - 2 .23 E+ 0 0 

= -2.253+00 

= AT (J) *Xf J) 
= -2.013+00 

= -2.273+00 

ii.WSIW 

= -2. 293+00 

= AT(J)*X(J) 
= -2.073+00 

= -2.313+00 

== -2 ^O^E + i 0 } 

= -2. 323+0 0 



A 1 ! m D) =' 
AT (2) = 

U( 27) = 
ATM) = 
AT(2{ = 

0 ( 28) = 
AT(1) = 

AT (2) = 

U{ 29) = 
At ( 1) = 

AT (2) = 

U ( 30) = 
AT(1) = 

AT (2) - 

U ( 31) = 
ATM) = 
AT (2) = 

Of 32) = 
AT ( 1) = 

AT (2) = 

Of 33) = 
AT(1) = 

AT (2) = 

Of 34) = 

AT < 1) = 

AT ( 2) = 

Of 35) = 
AT (1) = 

AT ( 2) = 

Of 36) = 
AT(1) = 

AT ( 2) = 

Of 37) = 
AT ( 1) = 

AT (2) = 

Of 38) = 
AT ( 1) = 

AT (2) = 

Of 39) = 
AT f 1) = 

AT ( 2) = 



-2.342+00 
-2.352+0 0 

-2.352+0 0 

A T (J) *X( J) 

-2.162+00 

-2.362+00 

-2.372+00 

AT (J) *X ( J) 
-2.182+00 
-2.372+00 

-2.332+00 

AT (J) *X ( J) 
-2.202+30 
-2.382+0 0 

'-mnw 

-2.392+0 0 

-2.392+00 

AT (J) *X ( J) 

-2.212+30 

-2.392+00 

- at 2 l&llii' 

-2.392+0 0 
-2.40E+0 0 
-2.40E+0 0 



U( 40) = 
AT ( 1) = 

AT 2 = 



== m&w 

-2.402+00 



*** ** ** *** *********** ******************************* *** *** 
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